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ABSTRACT 

A scheme to locate emitter positions using post flight 
processing of discrete airborne emitter bearing angles-of- 
arrival information and recorded aircraft position coor- 
dinates by Kalman filter techniques is developed. The 
signal intercept system was assumed to be operating in a 
multi-emitter environment and all data was sampled at 
discrete but time varying intervals. The aircraft position 
data is filtered directly in latitude and longitude and 
emitter locations are computed in latitude and longitude 
using vector methods. An extended Kalman filtering scheme 
is developed to compute emitter coordinates directly in 
latitude and longitude coordinates . 
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INTRODUCTION 



With the ever increasing reliance of the military forces 
on electromagnetic systems for communication, reconnais- 
sance, and weapons control, there is a correspondingly 
increasing requirement to detect and locate the position of 
the enemy emitters . 

The complexity of this problem was shown by F. Pfendtner 
in [1] . When there are multiple emitters in reasonable 
proximity and several observations , called direction finding 
(DF) bearings, are made, the number of possible locations I, 
of these emitters is found by 

I = m^n(n-l)/2 

where m is the number of emitters and n is the number of 
observations . 

If there were six emitters and ten observations of each 
emitter, there would be a possibility of 1,620 points of 
bearing line intersections, each a valid emitter position. 

A scheme was developed in [1] to locate the most prob- 
able location of the emitter based on the mean of all points 
of intersection associated with a given target. This scheme 
did not provide the desired degree of accuracy. So, a 
scheme was developed to Kalman filter all of the DF bearing 
correlated with a given target, thus finding an optimal 
estimate of these observations. The first and last estimates 
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of the DF bearings to each target were used to determine 
emitter location by triangulation methods. This scheme 
provided solutions much closer to the desired accuracy. 

Any solution is only as good as the data used to compute 
it/ SO/ L. L. Coburn developed a data sort scheme in [2] 
which would compare all of the observations and correlate 
each data point with a specific target to avoid the pos- 
sibility of basing the solution of an emitter position on 
observations not from that target. The sort was based on 
signal carrier frequency and pulse repetition frequency, 

PRF. The data sort utilized in [2] was only an initial sort 
in that any observations not passing a later comparison test 
were discarded and not saved for locating further emitter 
sites. 

In this study an initial data sort based on signal 
carrier frequency and PRF is utilized^ but all observations 
are eventually correlated to a target or are labeled as 
single line bearings. 

Also for this report a routine was developed to deter- 
mine optimal estimates of aircraft position coordinates by 
filtering and smoothing aircraft position observations. 

An extended Kalman filter was developed to filter the 
estimate of the target position directly in latitude and 
longitude. This routine could be used to track moving 
targets, or to filter emitter positions based on data from 
several flights. Only signal parameters, the estimates of 
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aircraft position, observed DF bearing angles, time data, 
and the estimated target position would need to be stored 
from each flight for further processing. 
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II. PROBLEM DESCRIPTION 



A. KALMAN FILTER THEORY 

Sequential estimation is characterized by the serial 
recursive processing of observations taken in time sequence. 
The result of every processing cycle is the current best 
estimate of the vector being estimated. This estimate there- 
fore embodies all observation data up to and including the 
current observation. As a new observation is made, the 
current estimate is updated to reflect this most recent data. 

In such an estimation scheme the calculations are iden- 
tical in nature from cycle to cycle so they are ideally 
suited for implementation on a digital computer. 

The problem presented in this report is that of the post 
flight processing of digitized data, but liie program utilized 
in this case could easily be adapted for a real-time proces- 
sor for in-flight computing and real-time locating of emitter 
sites. 

The Kalman filter [3] is a recursive filter of the type 
needed for this application. Since the data inputs are 
already in digital form, the discrete form of the Kalman 
Filter are utilized for processing on a digital computer. 

From the probabilistic description of the random signal 
and noise we can determine the probability with which a 
particular sample of the signal and noise will occur and we 
can therefore estimate x(k). This estimate will be denoted 
by x(k) 
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The discrete system under consideration satisfies 



x(k+l) = (|)(k)x(k) + w(k) (1) 

z(k) = h(k)x(k) + v(k) (2) 

where x is an n x 1 state vector, z is an ra x 1 output vec- 
tor, w is a zero-mean n x 1 vector of state excitation 
white noise, uncorrelated with the zero-mean-additive 
observation white noise vector v, is the state transition 
matrix and h is the observation matrix. The noise statis- 
tics are 



E |v (k) 




= R(k) 6 (k, j) 


(3) 


E |w (k) 


w( j)'^J 


1 = Q(k) 6 (k, j) 


(4) 


E |v(k) 




j = 0 for all Ck,j) 


(5) 


<S (k, j) 


■i: 


k = j 


(6) 



The Kalman filter recursion equations [4] are summarized 
below where X(k| j)- denotes the estimate of the state X(k) 
based, upon j measurement observations Z (1) ,Z (2) , . . . , Z ( j ) . 



P(kl 


k- 


1) 


= 4>(k,k-l)P(k-ll]< 


:-l)<J)(k,k-l)'^+Q(k) 


(7) 


G(k) 


= 


P (k|k-l)H(k) jH(k)P 1 


[klk-l)H(k)'^+R(k) 


-1 


(8) 


P(kl 


k) 


= 


P(k|k-1) - G(k)H(k)P (k|k-l) 




(9) 


X(kl 


k) 


= 


X(k|k-1) + G(k) 


Z (k) - H(k)X(klk- 


-1) 


(10) 


X(k| 


k- 


1 ) 


= (j)(k,k-l)X(k-ll 


k-1) 




(11) 



10 



where G(k) is the Kalman filter gain matrix and P(k|j) is 
the error covariance matrix. 



B. SYSTEM MODELS 

The emitter position locating system modeled was divided 

into three distinct systems, (1) aircraft navigation system, 

(2) the DF bearings, and (3) the target location. The 

combined system consists of five linear Kalman filters , plus 

one linearized Kalman filter, called an extended Kalman 

filter, and two smoothing filters. Each of these models 

will be described briefly in this section with more detailed 

descriptions in Section III, "Computational Procedures." 

2 

All of the systems are modeled by a linear 1/s plant. 
The state transition matrix, is 



4) (k+l,k) 



1 T(k+1) 

0 1 



( 12 ) 



where T(k+1) = TIME T(k+1) - TIME T (k) , TIME T being the 
time of observation. 

To minimize the affects of the inherent uncertainty of 
the system model, the values of Q should be increased to a 
value which ensures that each observation is utilized. The 
effect of increasing the magnitude of Q is seen from (7) to 
be larger values of the error covariance matrix, P, which 
leads to an increase in the filter gain matrix G. This 
means that the filter is paying more attention to the actual 
measurement to compensate for errors in the plant model. 
Thus, the more nonlinear the system dynamics, the larger Q 
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should be. If the measurement errors are in question, R 
should be increased which, as can be seen from (8) , will 
decrease G so the filter relies more on the total effect of 



all previous measurements, i.e. the previous estimate of the 
system states [5] . 

1 . Aircraft Navigation System Model 

The navigation system is modeled by a constant velo- 
city plant for each direction of aircraft travel, east-west 
and north-south, with the system states for each plant being 
aircraft position and aircraft velocity. Only the aircraft 
position fixes were observable so the objective of this 
filter is to filter the noisy observed position coordinates 
to obtain optimal estimates of own aircraft location. These 
estimates are used in processing the DF bearings and target 
positions . 

Since only aircraft position coordinates were observed, 
the observation matrix is H = [1 0]. This made W(k),V(k) 

and R(k) scalar variance terms and the bracketed terms in (8) 
and (10) become scalar as well. 



Since W is a scalar, (4) becomes 




(13) 



Substituting the expression for F into (13) yields 
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Q(k) 




(14) 



T^ (k) 
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2 . DF Bearing Model 



The system states for the problem of angle filtering 
are DF bearing angle-of-arrival and bearing rate. In this 
program the system dynamics are also modeled by a constant 
velocity plant. The bearing rate is unobservable so the 
observation matrix is H = [1 0] as in the navigation data 

filter equations. 

This model does not accurately represent the actual 
system since the estimated angular rate error increases with 
time[l]. However by introducing a non zero Q matrix this 
error can be reduced. The effect of Q on the accuracy of 
this model can be seen in the results obtained by L. L. 
Coburn [2] . 

3 . Target Position Coordinates Model 

The states of the target location system are lati- 
tude, latitude rate, longitude, and longitude rate while the 
observations are the noisy DF bearings only. To compute the 
optimal estimate of the states, the system was modeled by 
two linear constant velocity systems, one each for latitude 
and longitude. A linearized transformation of the measure- 
ment equation was utilized to provide DF bearing information 
to the latitude and longitude filters in a form they could 
use to filter their states. 

2 

The models for the two linear systems are again 1/s 
plants with H = [1 0] . 

The target location system model is shown in Fig. 1, 
and is discussed further in Section III, part F, "Extended 
Kalman Filter." 
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Figure 1. Extended Kalman Filter Block Diagram. 








C. SMOOTHING 



Two types of smoothing are utilized in this program, 
fixed point with the angle filter and fixed interval with 
the navigation data filter. The fixed point smoothing tech- 
nique will be discussed first. 

1. Fixed Point Smoothing 

In the process of angle filtering, the estimate of 
the DF bearing, 0(n|n), is a weighted "average" of all 
previous noisy DF bearings, 6 (1) , 0 (2) , . . . , 0 (n) . However the 
actual position finding algorithm (POSIT) utilizes the esti- 
mate of the first DF bearing, 0(l|n), as well as 0(n|n). 

So, the first bearing should be somehow weighted by all 
successive cuts, 0(2),...,0(n). The technique used to accom- 
plish this filtering is called fixed point smoothing. The 
smoothing equations are similar to the Kalman filter equa- 
tions in that they are recursive in nature and functions of 
similar statistical parameters. The difference is that the 
smoothing filters produce a previous estimate of the state 
subject to successive measurements. The fixed point smooth- 
ing equations used in this program are summarized below [6]. 
a. Gain Equation 

X(k|j) = X(k|j-1) + W(j)H (j)’'R”^(j) [z(j) 

- H(j)(|)(j,j-l)X(j-l| j-l)J (15) 

where j = k+1, k+2,..., and the initial condition is X(k|k). 
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( 16 ) 



b. Gain Equation 

W(j) =W(j-l)4) (j,j-l)'^ [l-S (j)P (j 1 j)J 

where W(k) = P(k|k) and S(j) = H(j)'^R ^(j)H(j) 

c. Covariance Equation 
P(k|j) = P(k|j-1) - W(j) [s(j)P(j| j-l)S(j) 

+ S(j)] W(j)'^ . (17) 

where the initial condition is P(k|k). P(j|j) and P(j|j-1) 
are the error covariance matrices from the optimal filter. 

2 . Fixed Interval Smoothing 

I 

The second type of smoothing utilized is the fixed 
interval smoothing. In the navigation data filtering routine, 
the flight track is broken into legs with a new leg being 
initiated any time the aircraft flies for more than two 
minutes without recording a position fix. Each leg is then 
an interval and each interval is filtered and smoothed 
separately. The motivation for the fixed interval smoothing 
routine is similar to that for smoothing in the angle filter- 
ing routine, i.e. each estimate should be influenced by each 
successive measurement as well as by each previous one. The 
fixed interval smoothing equations utilized in the angle 
filter are [6] . Utilized in the angle filter are [6] ; 
a. Filter Equation 

X(k|n) = X(k|k) + A (k) [x (k+1 1 n) - X (k+1 1 k)J (18) 

for k = n-1 ,n-2 , . . . , 0 , where X(n|n) is the boundary condition 
for k = n-1. 
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b. Gain Equation 

A(k) = P(k|k)(J) (k+l,k)^p“^ (k+l|k) (19) 

c. Covariance Equation 

P(k|n) = P(k|k) + A(k) |^P(k+l|n) 

- P(k+llk)J A(k)^ (20) 

This filter has the advantage taht it incorpor- 
ates the covariance terms, P(k|k) and P(k+l|k), as well as 
the estimates X(k(k) and X(k+l|k) from the Kalman filter 
equations, so the required number of computations is mini- 
mized. Since k = n-1, n-2,...,0, it is clear that this 
system of equations is recursive backwards in time so it does 
indeed produce a smoothed estimate of each navigational fix 
subject to all successive fixes on that leg. 

D. INITIAL EMITTER POSITION FIXING 

Each position on the earth can be considered to be the 
tip of a vector whose length is the radius of the earth. 

In this problem the radius of the earth is assumed to 
be constant. Even though it is known that the constant 
radius assumption is an inaccurate one, using a constant 
value for the radius produces an error of less than two per- 
cent of the distance involved anywhere on the surface of the 
earth [7] . Also by using this assumption this method is 
equally valid over the entire globe without regard for the 
radius . 

The position vector can be described either by its lati- 
tude and longitude or in x,y,z coordinates on a three 
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dimensional coordinate system with the center of the earth 
as the origin of the system, as in Fig. 2. 

The latitude is the angle in a meridian plane measured 
from the equatorial plane to the radius vector of the air- 
craft. Longitude is the angle in the equatorial plane 
measured from the Greenwich meridian to the meridian of the 
aircraft. The latitude of a point on the earth is in the 
range 0 to 90 degrees in the northern hemisphere and from 0 
to -90 degrees in the southern hemisphere. The longitude of 
a point on the earth is in the range 0 to 180 degrees in the 
eastern hemisphere and from 0 to -180 in the western hemis- 
phere. In the 3-D right hand coordinate system the positive 
2 axis passes through the geographic north pole, the positive 
X axis passes through the Greenwich meridian and lies in the 
equatorial plane and the positive y axis passes through 90 
degrees east longitude and lies in the equatorial plane [8]. 

The relationship between the latitude and longitude 
coordinates (<}),0) and the (x,y, 2 ) coordinates is expressed 
by the formulae 

X = cos({> COS0 (21) 

y = coscfi sin0 (22) 

2 = sin4> (23) 

From vector algebra we know that when two vectors are 
multiplied together vectorially the resultant is called the 
cross product. The resultant is another vector whose direc- 
tion is perpendicular to the plane of both of the original 
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Figure 2. Illustration of Relation Between Station 
and (x,y,z) coordinates. 



19 



vectors and is called the normal vector. Therefore if the 
aircraft position vector is crossed into the vector normal 
to the DF bearing plane, a normal vector parallel to the 
surface of the earth is produced. This multiplication is 
carried out for the smoothed initial DF bearing, 9(l|n), and 
the filtered last bearing, 0(n|n). Then if the bearing 
vectors are assumed parallel to the surface of the earth at 
the target position, their cross product will produce a 
vector through the center of the earth at their point of 
intersection. This vector is the position vector of the 
target. 

The assumption of the DF bearing being parallel to the 
earth's surface at the target and at the position of the air 
craft can be easily understood when it is realized that the 
bearing vector is actually the projection of the plane con- 
taining the DF bearing onto the surface of the earth. 

The difficulty of the vector method arises when an 
attempt is made to describe the bearing vector in an earth 
centered cartesian coordinate system so the cross product 
can be obtained. This description is found by a series of 
three coordinate system rotations. The resultant of a suc- 
cession of coordinate system rotations is simply the dot 
product of the coefficient matrices of each rotation [1] 
and [9] . 

The rotations made in this program are shown in Figs. 3, 
4, and 5. The original coordinate system is denoted (i,j,k) 
after the first rotation (i*,j*,k*), after the second 



20 



k 




Figure 3. Rotation of Axes about j Axis. 




Figure 4. Rotation of Axes about k* Axis. 
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Figure 5. Rotation of Axes About Local Vertical. 
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rotation (i** , j ** ,k**) , and after the third rotation 
(i*** , j*** . The first rotation about the negative j 
axis is expressed as 



i*' 




coscj) 0 sincf) 




i 


j* 




0 10 




j 


k* 




-sin<() 0 cos<() 




k 



(24) 



The second rotation is about the k* axis and is represented 
by 



* 




COS0 


sin6 


0 




i* 




j * * 


= 


-sinO 


cos 6 


0 




j* 


(25) 


k** 


1 


0 


0 


1 




k* 





The resultant of the first two rotations is a target centered 
coordinate system expressed in cartesian coordinates. In 
this coordinate frame, i** is local vertical, j** is local 
west and k** is local north. 

The third rotation is a rotation by -a about the i** 
axis (local vertical) which after making siitplifying trig- 
onometric substitutions is 







10 0 




1** 


j ★ * * 


= 


0 sina cosa 




j ** 


]^*** 




0 -cosa sina 







Since k*** is the unit vector in the bearing plane, j*** 
is the normal to the bearing plane and after carrying out 
the indicated matrix multiplications, is expressed in terms 
of the original coordinates as 
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N = j*** = (-sinasin6-cosasiri(})cos0) i 
+ (sinacos0-cosasin({)sin0) j 
+ (cosacoscf)) k . (27) 

Then by cross multiplying the aircraft position vector 
associated with N, into N, the vector which represents the 
DF bearing vector is determined. This method was utilized 
in developing subroutine POSIT which is discussed in Appen- 
dix C. 

E. EXTENDED KALMAN FILTER 

Since the Kalman filter is optimum only when the system 
differential equations and measurements are linear, a rela- 
tionship had to be found to linearize the nonlinear measure- 
ments associated with emitter locating. The sought for 
relationship can be obtained by a Taylor series expansion of 
the target location. This series expansion of the nonlinear 
measurements can be substituted for the coefficient matrices 
in the Kalman filter recursive gain equations and computation 
then proceeds just as in the discrete algorithm as described 
previously in this report. This employment of the Kalman 
filter is frequently referred to as the "Extended Kalman 
Filter." It is an intuitive but frequently successful appli- 
cation of the Kalman filter in the absence of truly optimum 
filters for non-linear systems [10]. 

These techniques are only approximate. They require 
that the disturbances, measurement noises, and uncertainties 
in the state be of such a size that the higher-order terms 
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ignored in computing the error are insignificant. It was 
felt that for this system, where one of the objectives was 
simplicity of computation, that though the higher order 
terms are existent the system dynamics model used was a 
satisfactory approximation of the actual plant dynamics. 

In the case of emitter locating from an aircraft using 
the extended Kalman filter routine, we are actually filter- 
ing in latitude and longitude while our observations are 
noisy DF bearings only, i.e. 

Z (k) = e (k) + V(k) . (28) 



It is obvious that no pseudo-cartesian coordinates can be 
generated from this measurement. The non-linear measurement 
process must therefore be represented by a linear approx- 
imation . 

From the development of the Kalman filter equations [6] , 
it can be seen that 

X(k|k) = 4>(k,k-l) X(k-l|k-l) + E[X(k|k) I Z (k) ] (29) 

Let G(k)Z(k) = E [X (k | k) Z (k) ] where Z (k) = M(k) X (k | k-1) . So 
the estimated measurement equation becomes 

Z(k) = 6(k) (30) 

where [2] 



e (k) 



TAN 



-1 I ^T 

- L 



(31) 



where is the target longitude, X is the aircraft longi- 
tude, is the target latitude, and L is the aircraft 

latitude . 



25 



Substituting this expression into the Kalman filter 
equations, the recursive filter equation becomes 

X(k+1) = 4>(k+l,k)X(k) + G(k)[9(k) - 9(k)]. (32) 

Expanding the measurement equation 

9 = M(X,L) (33) 

about the most recent optimal estimate and ignoring higher 
order terms results in 

9 = M(X*,L*) + 

from which we see that 




The Kalman filter recursion equations, (7) through (11), 
may then be rewritten to include the nonlinear observation 



matrix M, and are given by 

P(k|k-1) = 4»(k,k-l)P(k-l|k-l)(}.(k,k-l)'^+ Q(k) (36) 

G(k) = P(k|k-l)M(k) [M(k)P (k|k-l)M(k)'^+ R(k)]"^ (37) 
P(k|k) = P(k|k-1) - G(k)M(k)P (k|k-l) (38) 

X(k|k) = X(k|k-1) + G(k) |^Z (k) - M (k) X (k | k-l)j (39) 

X(k|k-1) = 4 . (k,k-l)X(k-l|k-l) (40) 



X* + -^ 
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L*. 



(34) 
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III. COMPUTATIONAL PROCEDURES 



A. NAVIGATIONAL DATA FILTERING - (SUBROUTINE NAV) 

The first step in the problem of finding a target is 
that of filtering the aircraft position estimates. Aircraft 
navigation data was sampled and recorded at discrete but 
time varying intervals. As stated in Section II, part B.l, 
only the position fixes were measured so the velocity is 
only estimated and is strictly a product of the model used 
to represent the aircraft. Since the aircraft position fixes 
were taken at random intervals, there are extended periods 
during which no navigation data is available and when the 
flight track could be altered drastically. Therefore, the 
flight track is broken into legs to ensure that the program 
does not attempt to filter through these abrupt changes. 

The criteria used in this program to establish the end 
of a leg is a simple time test. If T(k), the time between 
navigation fixes, exceeds 120 seconds, the current leg is 
terminated and a new leg is initiated. 

If a leg was found to consist of three or fewer data 
points, that leg was neither filtered nor smoothed, but 
rather the measured data was used for the filtered and 
smoothed estimate of position, i.e., SLADSM (K) =ACLAD (K) . No 
estimation of velocity was computed for these legs. After 
the entire flight track was divided into legs, the Kalman 
filter was initialized. 
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The navigation data filter consists of two nearly iden- 
tical Kalman filters, one to filter latitude and the other 
for longitude filtering. The system dynamics for the air- 
craft are modeled in each direction by a constant velocity 
plant. 

Since equal angles of latitude and longitude yield equal 
distances of movement only at the equator, a correction 
factor must be applied to angular measure as either pole is 
approached from the equator. 

At 60 north latitude, for example, one degree of move- 
ment in latitude measures sixty nautical miles while one 
degree of movement in longitude only measures thirty 
nautical miles. This requires that the longitude angular 
distance be corrected by the cosine of the local latitude 
coordinate so that the two filters will have equal units of 
distance. The position estimates of the navigation data 
filters are based on estimated distances traveled, i.e. 

Xl(k|k) = Xl(k|k-1) + Xl(k|k-1) T(k) (41) 

The estimated changes in longitude position will be off by 
a value of 1/cos (latitude) , so (41) was modified to 

Xl(k|k) = Xl(k|k-1) + Xl(k|k-1) T (k) cos (latitude) (42) 

• Equivalently, Xl(k|k-1) can be reduced by the cosine of 
the latitude directly, which is the method used in this 
program. The equation used in NAV then is 

VELED (K)= (VELED (KK) + G2 (K) *ELON (K) ) *COS (SLA (K) ) (43) 
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where VELED is the aircraft velocity east in degrees per 
second, G2 is the Kalman filter gain, ELON is the Kalman 
filter error term and SLA is the latitude coordinate of the 
aircraft. The same correction is applied to the smoothed 
XI (k) term, VELEDS, in the smoothing filter. 

To initialize the latitude filter, the initial position 
estimate, SLAD(KI), was set equal to the first measured 
position, ACLAD(KI). The aircraft velocity was not observ- 
able, so the initial velocity was estimated by 

VELND(KI)= (ACLAD(KI+1) - ACLAD (KI ) ) /T (KI+1) (44) 

where T(KI+1) is the time increment from time KI to time 
KI+1. X(l|0) was assumed equal to X(0|0) so SLATD(KI), the 

predicted value of SLAB, was also set equal to ACLAD (KI). 

The longitude filter was initialized in the same manner 
as the latitude filter with the only change being that the 
velocity east was corrected by the cosine of the latitude 
to correct for the curvature of the earth as discussed above. 
Therefore 

VELED (KI) =( (ACLOD (KI+1) - ACLOD (KI ) /T (KI+1) ) 

X COS (SLA(KI) ) (45) 

The initial uncertainty of position and velocity on 
filter initialization was accounted for in the initial values 
of the error covariance matrix P(l|o). The error in the 
initial position fixes by the navigational computer were 
assumed to be very small and so the initial covariance matrix 
P(1|0) , was set equal to the identity matrix. 
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The measurement noise, v, is assumed scalar so by (3) 




The value of R will change for each system, depending upon 
the accuracy of that system, but it is assumed constant for 
each data set. 

The smoothing filter is recursive in negative time so 
the first estimate of position computed by the smoothing 
filter is the next to the last fix in that leg. Therefore 
to initialize the smoothing filter, the first smoothed 
estimate SLADSM(N), was set equal to the last filtered posi- 
tion estimate SLAD(N). The error covariance matrix P, used 
to compute the smoothed position estimates is the same 
matrix computed for the Kalman filter, so there was no P 
matrix to initialize. 

It was found that occasionally the aircraft navigational 
computer would produce a totally erroneous position fix, to 
check for this occurrence, each Kalman filter error term, 
E(k) = Z (k) - X(k+l|k), was checked and if it exceeded a 
certain value, denoted test, the data point was rejected. 

The estimate of the state, X(k+l|k), was inserted as the 
estimate of position, i.e. in the latitude filter 

SLAB (K)=SLAD(K-1) + VELN (K-1) T (K) (47) 

The equations used in the navigation data filter 
SUBROUTINE NAV) are derived in Appendix A. 
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B. ANGLE FILTERING - (SUBROUTINE GEORGE) 

After the navigation data is filtered and smoothed the 
processing switches to subroutine GEORGE, which is basically 
the program presented in [2] , This subroutine sorts the 
emitter data and then filters and smooths the DF bearings. 

To adapt the program presented in [2] , for use in this 
problem, the data sort routine was changed, a new smoothing 
filter was inserted and the emitter position locating 
algorithm was replaced by a vector solution method which 
is included in subroutine POSIT. 

The data sort used in this program is shorter than the 
original routine. In the data sort routine, the error 
interval associated with the measured values of signal 
frequency and PRF was opened up to approximate the errors 
of the system being simulated. This test interval can 
easily be changed to any desired width to fit the system 
being simulated. 

It was found that the PRF value was zero in some data 
sets. In these cases, the DF bearing associated with these 
particular points were correlated with the previous signal 
with the same carrier frequency. 

All of the DF bearing angles are checked for target 

correlation as in [2] , but instead of discarding any data 

2 

points which do not pass the test E (K) < (Pll (K) + 

RCUT) *TSTCUT, being discarded, they are assigned to a new 
target. RCUT is the assumed value of the variance of the 
measurement noise v, and TSTCUT is a multiplier to vary the 
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A 








size of the gate. This routine was inserted because with 
the method used in [2] , only one target of each FREQ and PRF 
could be processed from each data set; data from all other 
similar emitters were discarded. 

The smoothing routine utilized here is shorter and does 
not require the computation of the inverse of the P matrix 
as was required in [2] , since computing the inverse of a 
matrix consumes a lot of computer time. The smoothing 
filter equations used are derived in Appendix B. 

After each DF bearing, THTD (K) , is filtered and the 
first DF bearing, THTDl(k), is smoothed based on all succes- 
sive bearing estimates, a test is made to determine if 
processing should be switched to extended Kalman filtering, 
which is done in subroutine EXTEND. This test compares 
Pll (K) with the product of EXTEST and RCUT, where EXTEST is 
a multiplier to vary the size of the gate. If EXTEST is 
set equal to zero, the processing will always stay in the 
angle filter. As EXTEST is increased the processing will 
switch to EXTEND earlier and earlier in the data sequence 
but the initial estimate of the target position used to 
initialize the extended filter will be worse, as will the 
initial value of the P matrix in the extended filter equa- 
tions described in part F of this section. 

If it is decided that all of the DF bearings correlated 
to a target will be angle filtered, GEORGE calls subroutine 
PREPARE which in turn calls subroutine POSIT which computes 
the emitter location based on the DF bearings THTDl and 
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THTD directly. These subroutines are discussed later in 
this section. 

The value of the multipliers of both tests in GEORGE , 
TSTCUT and EXTEST, are calling arguments for the subroutine 
so they can be controlled by the main program. 

All of the Kalman filter initializations for GEORGE 
are discussed in [2] . The fixed delay smoothing equations 
are initialized with the initial smoothed estimate THTDl(l), 
being set equal to the initial filtered estimate THTD(l). 
THTD(l) was set equal to the measured value of the first DF 
bearing, THETAD(KI). 

C. SUBROUTINE PREPARE 

When vector products are used, the order of multiplica- 
tion is critical; if the order is reversed, the resultant 
will be reversed. In the problem of emitter position 
locating, a reversed resultant will produce a fix on the 
opposite side of the earth. PREPARE is written to prevent 
this occurrence. First the direction of the track of the 
aircraft is computed. Then THTD and THTDl are checked to 
determine on which side of the track they lie and ensure 
that they both lie on the same side of the track. If they 
do not, no position fix is calculated. If they do lie on 
the same side of the track, they are checked to see if they 
cross. If not, no fix is computed. PREPARE then computes 
the calling arguments for POSIT - ACLAD, ACLON, and THD. 

ACLAD and ACLON are the latitude and longitude coordinates 
respectively of the aircraft at the times the two DF bearings 
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were recorded. THD contains the direction of the two bear- 
ings THTDl and THTD. In so doing, it ensures that the DF 
bearing with the larger angle of arrival is crossed into 
the bearing with the smaller angle of arrival and not vice 
versa. PREPARE is also called by ELIPS6 and EXTEND. 

D. COMPUTING INITIAL POSITION - (SUBROUTINE POSIT) 

POSIT then computes the desired location by the method 
described in Section II, part D. First the bearing vectors, 

/\ I 

^(1 n) , and £(n|n), are expressed in the earth centered 
cartesian coordinate system. Then the cross product of the 
two bearing vectors is computed giving the target vector in 
X, y, 2 coordinates. These coordinates are converted to 
latitude and longitude coordinates by 

TLAD = TAN“^( — =^i===- (48) 

\ \/xl^+X2 j 



TLOD 



TAN 



X2 

XI 



(49) 



where XI, X2, and X3 are the x, y, 2 coordinates respectively. 
An example illustrating the method used to find the target 
vector is given in Appendix C. 



E. DEFINING THE ERROR ELLIPSE - (SUBROUTINE POINTS) 

If it is decided that the data should be processed by 
the extended Kalman filter, POINTS is first called. POINTS 
uses POSIT to compute the intersections of the edges of the 
cones of error associated with THTD and THTDl. These points 
are shown in Fig. 6. POINTS ensures that PTLAT (1 , I , J) , 
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Figure 6. Target Position Error Covariance Ellipse. 
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PTL0N(1,I,J) is always the intersection closest to the 
flight track and it determines if the DF bearings THTDl and 
THTD do in fact cross. If they do not, it makes sure that 
EXTEND is not called by returning to the calling program at 
a point after the EXTEND call. 

F. EXTENDED KALMAN FILTERING - (SUBROUTINE EXTEND) 

In linearizing the system by using a Taylor series expan- 
sion, it was assumed that the M matrix would be fairly con- 
stant over the range of uncertainty of x, therefore the 
initial value of x, x(0), must be a good approximation of 
the true value of x or the filter can diverge. To find an 
initial estimate of the true value of x, the DF bearings are 
first angle filtered in subroutine GEORGE. When the 
covariance of error of the current bearing estimate, Pll (K) , 
becomes less than EXTEST times the variance of the measure- 
ment noise, RCUT, the processing is switched to the extended 
Kalman filter routine, EXTEND. 

EXTEND calls PREPARE for an initial estimate of the 
target position coordinates, TLAD, and TLOD. EXTEND then 
computes the semi-major axis, a, and the semi-minor axis, c, 
of the error covariance ellipse described by the coordinates 
from POINTS and centered at the coordinates computed by 
PREPARE . 

The length of the semi-major axis of the error ellipse 
was assumed to be the distance from the initial target loca- 
tion, TGT, to the intersection of the error cones closest 
to the flight track. These points are shown in Fig. 6. 
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The length of the semi-minor axis is found in the following 
manner. 

The distance from the target position, TGT, to point 3 
and the distance from TGT to point 4 are computed. The 
projection of the average of these two distances on to a 
line perpendicular to the semi-major axis is the length of 
the semi-minor axis . 

The orientation of the error ellipse on the surface of 
the earth is taken to be the amount of clockwise rotation of 
the semi-major axis from the meridian passing through the 
center of the ellipse. 

A and c uniquely describe an ellipse in an x' y' coor- 
dinate frame according to 



2 2 

2^- + iL- = 1. 
2 2 

c a 



(50) 



The x'y' system is rotated by an angle (90-a) degrees from 
the xy system in which the extended Kalman filter functions. 
The X and y axes correspond to longitude and latitude 
respectively on a flat earth model. The extended filter will 
find an optimal estimate of the coordinates of the emitter 
position in the xy system. To describe the error ellipse in 
the xy system, a coordinate system rotation was made accord- 
ing to the transformation matrix. 



( 51 ) 



~x 




cosa 


-sina 




x' 


Y 




sina 


cosa 




_y'_ 
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After performing this transformation and making simplifying 
trigonometric substitutitms (see Appendix D) the initial 
values for the covariance matrix P , become 



Pll(KI) = (A sina)^ + (C cosa)^ 


(52) 


P12 (KI) = (A^-C^) sinacosa 


(53) 


2 2 

P22(KI) = (A cosa) + (C sina) 


(54) 



Using (31), EXTEND computes an initial estimate of 6, 

TX, which is used to compute the initial extended filter 
error term, ER(KI)=THETA(KI) -TX(KI) , where THETA is the 
measured DF bearing angle in radians. The initial gains 
associated with the nonlinear measurement equation are found 
from (37). The initial estimate of longitude, XTD, is set 
equal to TLOD, and YTD, the initial value of latitude, is 
set equal to TLAD. 

The initial inputs to the linear longitude and latitude 
filter, XTDl and YTDl , are then found by substituting (11) 
into (10) , rewritten as 

XTDl (KI)=XTD(KI) + GX(KI)ER(KI) (55) 

YTDl (KI)=YTD(KI) + GY (KI ) ER (KI) . (56) 

Then the outputs, XTD and YTD, of the linear filters are fed 
into the linearized filter and the process proceeds as 
described for initialization. 

The longitude and latitude filter equations are identi- 
cal to the corresponding filters in subroutine NAV except 
for notation, as listed in Appendix A. 
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The $ matrix for the linearized measurement filter is 



the identity matrix since the states of this filter are 
longitude and latitude only. 

On each recursion of the filter the error term ER, is 
compared with a gate identical to the correlation gate in 
subroutine GEORGE. Any DF bearings failing the test are 
assigned to a new target and are processed either in the 
angle filter or in EXTEND on a later call of the subroutine 
The extended Kalman filter equations are derived in Appen- 
dix D. 
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IV. PRESENTATION OF RESULTS 



The Monte Carlo simulation developed in [2] was utilized 
to accomplish program validity and error analysis studies. 

The scenario developed for that simulation was of an aircraft 

flying south along the 118®W meridian at a ground speed of 

600 knots and with heading of 180°. Bearing angles-of- 
arrival were recorded from two VORTAC stations located at 

Emitter 1 Oceanside VORTAC 33. 24055 °N 

117. 41694°W 

Emitter 2 San Diego VORTAC 32.78222°N 

117. 22444°W 

DF cuts and aircraft position fixes were recorded every six 
seconds alternately from each target giving a uniform 
sampling interval. Known true bearing angles were computed 
numerically from the aircraft position coordinates and the 
emitter position coordinates to obtain a very a'ccurate data 
base. The DF cuts obtained are shown in Fig. 7 for emitter 
1 and in Fig. 8 for emitter 2. 

Normally distributed, zero mean random noise with an 
assumed variance of 1 was added independently to the lati- 
tude fixes, longitude fixes, and angles-of-arrival. The 
errors in aircraft heading and angle-of-arrival were combined 
into the single angle-of-arrival error. The flight track 
and noisy DF bearings are shown in Figs. 9 and 10 for emit- 
ters 1 and 2 respectively. 
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Figure 10. Noisy Lines-of-Bearing on Emitter 2. 
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A. ERROR ANALYSES 



A large number of simulation runs were executed to 
obtain a statistically valid error analysis, where each 
run constituted a complete mission. The results of these 
analyses are given in Appendix E and are summarized below 
for the two simulation emitters. 

The results of the error analysis of the navigation data 
filter are listed on page . The average of the noise 
added to the positions is shown as is the mean-square value 
of that noise. By comparing the listed mean-square error 
of the positions with that of the noise, it can be seen that 
the model utilized in the program has a bias which develops 
after a large number of runs. Each run is a complete flight 
of 61 position fixes, so the result after 45 runs is the 
statistical average of 2745 data points. The results of 2, 
10, 45, and 50 runs was found to be 

LATITUDE LONGITUDE 



Runs Mean-Square 
Noise 



Mean-Square 

Error 



Mean-Square Mean-Square 
Noise Error 



2 


.427 


.326 


10 


.937 


1.02 


45 


1.26 


1.37 


50 


1.19 


1.31 



1. 80 


1.21 


1.24 


1.16 


1.19 


1.24 


1.14 


1.23 



_ 8 

The units for this list are degrees times 10 . The error 

associated with each individual position fix on a single run 
is shown on page 
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For the analysis of the angle filter, a range error was 
computed from each estimated emitter position latitude error 
and longitude error, and all errors were statistically 
averaged for the total number of runs. 

The longitude error which is perpendicular to the flight 
path was found to be much larger than the latitude error. 
This result agrees with the theory used to develop the 
ellipses which describe the initial covariance matrix for 
the extended Kalman filter. This result also agrees with 
the final orientation of the target error ellipses as shown 
on page 51 and 52. The results of this analysis are sum- 
marized below for 50 runs. 



EMITTER 1 
EMITTER 2 



AVERAGE 

LATITUDE 

ERROR 

.684 

.685 



AVERAGE 

LONGITUDE 

ERROR 

1.129 

1.870 



AVERAGE 

RANGE 

ERROR 

1.391 

2.098 



The units of the above table are nautical miles. 

The results of- the error analysis of the extended Kalman 
filter are shown on page 73. The errors of each individual 
flight which are listed on that page point out the dependency 
of this filter on the accuracy of the initial estimate of the 
emitter position. Since the initial estimate is based on 
only four DF bearings for this simulation, this estimate is 
heavily weighted by the noise added to the first bearings and 
the rate of convergence of the filter. The results of the 
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analysis of the extended filter are given below for 50 runs 
with the units being nautical miles. 





AVERAGE 


AVERAGE 


AVERAGE 




LATITUDE 


LONGITUDE 


RANGE 




ERROR 


ERROR 


ERROR 


EMITTER 1 


1.535 


4.654 


4.988 


EMITTER 2 


. 872 


7.784 


7.876 



B. COMPUTER PROCESSING OF SIMULATED DATA 

A series of plots showing the ability of this program to 
locate target positions in the absence of noise starts on 
page 50. The number in the lower right corner is the number 
of the DF bearing estimate associated with that target which 
was used to compute the target position and error ellipse in 
that plot. The plots on page 51, 52 and show the four 
points of intersection computed by POINTS which describe 
the error ellipse. From these plots, it can be seen that 
the error ellipse does accurately describe the area of the 
probability region, associated with each position fix. 

The output of a single run of the program using the 
simulated data starts on page 76. The first run assumes 
that processing will be strictly by the angle filter. The 
output of a run in which the extended filter was utilized 
starts on page 110. Plots of the error ellipses associated 
with the covariance matrices of each filter are included in 
the output. 

These series of plots show the change of orientation of 
the error ellipse as the aircraft progressed along its flight 
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path. They also illustrate the decrease in area of the 
ellipses as more data is collected and as the angle between 
the smoothed initial bearing 6 (1/N) , and the filtered final 
bearing 6 (N/N) increased. 

By comparing the plots of the ellipse associated with 
the angle filter on page 50 and the plot on page 53 associa- 
ted with the extended filter, it can be seen that the 
extended filter is initialized with the same error covari- 
ance as the angle filter. 

Further comparison of the two series of plots shows that 
the position of the centers of the ellipses produced by the 
angle filter are much more erratic than those of the extended 
filter. This indicates that the angle filter has a faster 
response to each new bit of data than the extended filter. 

The response may seem too fast, but in order to have a rapid 
rate of convergence of the filter so processing could switch 
quickly to the extended filter, fast response is necessary, 
so this is a compromise. 

The slow response of the extended filter is shown by 
the relatively slow rate of rotation of the error ellipse. 

The slow response is desirable to prevent the filter from 
converging too rapidly onto a wrong point if it is initial- 
ized with a poor initial position fix. 

C. AIRCRAFT FLIGHT DATA PROCESSING 

The output of a computer run using data from an actual 
flight starts on page 144. The effectiveness of the data 
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sort routine is shown by the lists on page 146 and 147. The 
first list is the result of the sort on PRF and FREQUENCY 
only. The second list is the final correlation after the 
data has been correlated to targets using the test discussed 
on page 31. 
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CONCLUSIONS 



The fact that Kalman filtering of digital data works is 
nothing new, many examples can be found in the literature. 
This report has shown a particular application of the Kalman 



theory and presented a program which will work in that 
application, i.e. the processing of airborne DF information. 
There are several areas of this study which need more 

research and testing. A more complete model for the navi- 

! 

gation filter could be developed which would reduce the bias 
present in the one utili2ed for this report. Then it should 
be determined if the bias is harmful jor not and if it is 
worth the resulting increases in computer processing to 
remove the small error. The response of the two emitter 



if there is a more optimal Q for 

A program for plotting the error ellipses of each target 
for each filtering scheme was presented. This program 
provides a capability for displaying 'graphically the effect 



of varying the different parameters which are inputs to the 
subroutines, plus the effect of varyijng filter response time. 

Many current elint systems have J digital computer as a 
link in their processing chain, but ijt is used strictly as 
a device to plot the data and no attempt is made to compute 
an optimal emitter location solution. By implementing this 



position locating filters should 
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Kalman filter program, the effectiveness of the elint system 
could be greatly enhanced by reducing manual processing time 
and produce more accurate target position coordinates. 
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APPENDIX A 



DERIVATION OF SCALAR KALMAN FILTER RECURSION EQUATIONS 



The Kalman filter equations for all of the linear models 
in this program can be derived in the same general form 
described below. The variable names used in each individual 
subroutine to represent the general terms in the derivation 
are listed at the end of this section. 

The Kalman filter recursion equations from page 10, (7) 



through (11) , are listed below: 

P(klk-l) = 4) (k,k-l)P (k-l|k-l)4) (k,k-l)'^ + Q(k) (lA) 

G(k) = P(k|k-l)H(k)'^tH(k)P(kIk-l)H(k)'^ + R(k)]“^ (2A) 

P(klk) = P(klk-l) - G(k)H(k)P(kIk-l) (3A) 

X(klk) = X(klk-l) + G(k) [Z(k) - H (k) X (k 1 k-1) ] (4A) 

X(klk-l) = (j) (k,k-l)X(k-lIk-l) (5A) 



where in this application <|)(k+l,k) 
H(k) = tl 0] , 



1 T(k+1) 

0 1 



the P and Q matrices may be considered to have scalar com- 
ponents given by 



~P11 


P12 




"oil 


QI 2 " 






and 






P21 


P22 




_Q21 


Q22_ 



respective ly , 
G1 



and the G matrix is a 2x1 matrix of the form 



G2 



L_ _l 
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Writing (2A) in matrix notation yields 

















~G1 




Pll P12 




1 






Pll P12 




1 






= 










fi ol 








+ R 


G2 




P21 P22 




_0_ 




L . J 


P21 P22 




_0_ 



















(6A) 



and for the observation matrix H(k) = [1 0], the inverse 

term becomes a scalar allowing the gain terms to be computed 
directly as is shown below; 




(7A) 



which results in the scalar gain equations 



Gl(k) 



Pll (k|k-l) 
Pll(k|k-1) + R(k) 



G2 (k) 



P21(k|k-1) 
Pll(kjk-l) + R(k) 



(8A) 



(9A) 



let the P matrix be defined by 

P(k/k-l) =E [e(k) - 0 (kik-l)J [e(k) - e (k|k-l)J (lOA) 

from which it can be seen that since 0 and 0 are statisti- 
cally independent , ' where 

. /V 

0 = 0 - 0 , 

then P12 = P21, and the P matrix is symetric. From (15) it 
can be seen that the Q matrix is also symetric. Equation 
(9A) then becomes 



G2 (k) 



P12 (kIk-1) 
Pll(k|k-1) + R(k) 



(llA) 



To solve for the prediction covariance terms, (3A) was 
substituted into (lA) giving 
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Pll P12 




1 T~ 






~P11 P12 




~Gl“ 


P12 P22 




0 1 






P12 P22 

L J 




G2 



k-l|k k|k-l 



Pll 


P12 






1 0 




Qll 


Q12 


P12 


P22 






T 1_ 




_Q12 


Q22_ 




r— 1 

1 








(12A) 





VARIABLE NAMES USED IN PROGRAM TO REPRESENT 
VARIABLES IN GENERAL DERIVATION 



General 

Variable 


R 


P 


P G 


X 


X 


X 


E 


Z 


Subroutine 

Name 


















NAV 


RNAV 


SP 


SPKK SG 












LATITUDE 








SLAD 


VELED 


SLATD 


ELAT 


ACLAD 


LONGITUDE 








SLOD 


VELND 


SLOND 


ELON 


ACLOD 


GEORGE 


RCUT 


P 


G 


THTD 


TDTD 


TPTD 


E 


THETAD 


EXTEND 


EXTEND 


EP 


G 












LATITUDE 








XTD 


XTDDOT 


XTDHAT 


EX 


XTDl 


LONGITUDE 








YTD 


YTDDOT 


YTDHAT 


EY 


YTDl 


LINEARIZED 
















MEASURE- 




P 


- 


XTDl 


- 


TX 


ER 


THETA 


MENT 








YTDL 


- 


TX 


ER 


THETA 
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APPENDIX B 



DERIVATION OF SMOOTHING FILTER EQUATIONS 
A. FIXED POINT SMOOTHING 

The equations used to smooth the estimates of the first 
DF bearing, THTDl, for a given target are listed on page 15 
and are repeated below with k = 1. 

1 . Filter Equation 

X(l|j) = X(l|j-1) + W(j)H(j)'^R"^(j) [z(j) 

- H ( j) (|) ( j , j-1) X (j-l| j-l)J (IB) 

where j = 2,3,..., and the initial condition is X(lfl). 

2 . Gain Equation 

W(j) = W( j-1) <|) ( j , j-l)"^ jjr-s ( j )P ( j I j)J (2B) 

where W(l) = P(l|l) and S(j) = H(j)'^R ^(j)H(j) 

3 . Covariance Equation 

P(l|j) = P.(l|j-1) - W(j) [s(j)P(j| j-l)S(j) 

+S(j)J W(j)"^ (3B) 

where the initial condition is PCljl). F(j[j) and P(j|j-1) 
are the error covariance matrices from the optimal filter 
and predictor respectively. Since H = [1 0] and R(j) is a 
scalar, these matrix equations become scalar expressions. 

To compute a smoothed estimate of X(l|j), it is first 
necessary to solve (2B) for the values of the gains to be 
used in (IB) . 
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First solve for S(j) 



— —I 

1 


F fl 0 l = 


1 /R 


0 


_0 


R L J 


_ 0 


0 _ 



S{j) = 

Then noting that 

”l 0 
_T(j) 1 

Equation (2B) becomes 

"l o‘ 

T 1 



(4B) 



Wll 


W12 




Wll 


W12 


W21 


W22 




W21 


W22 




(1/j) 


(1/j-l) 



(5B) 



1 0 
0 1 



1/R 0 

0 0 



Pll 


P12 


P12 


P22 


L. 


(j/j) 



(6B) 



To solve (IB) first note that 





~1 


T 


~^l’ 


= H( 3 ) ^X( 3 -l| 3 -I) = [^1 oj 


_0 


1 _ 


_''2_ 



so therefore let E ( j ) =z ( j) -Xj^( j) - ( j ) T ( j ) . 

notation used in the program 



Xi + X 2 T (7B) 
Then in the 



THTDl 




THTDl 


1 


Wll 


W12 


TDTDl 

(1/j) 


1 


THTDl 

(1/j-l) 


*r 

1 


_W21 


W22 



E(j) 

R 



(8B) 



The error covariance matrix for the fixed point smoothing 
filter is 



Dll 


D12 


D21 


D22 



so (3B) written matrix form is 



(9B) 
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Dll 


D12 




Dll 


D12 




Wll 


W12 




~1/R 


0 




~P11 


P12 


_D21 


D22_ 




_D21 


D22_ 




_W2i 


W22_ 




_ 0 


0_ 




_P12 


P22 



(llj) 



1/R 0 




1/R o” 




Wll W21 














(lOB) 


0 0_ 




_ 0 0_ 




_W12 W22 





B. FIXED INTERVAL SMOOTHING 

The fixed interval smoothing equations are listed on 
page and are repeated below. 

1. Filter Equation 

X(k|n) = X(k|k) + A(k) j^X (k+1 1 n) - X (k+1 1 k)J (IIB) 

for k = n-l,n-2 , . . . , 0 , where X(njn) is the boundary condi- 
tion for k = n-1. 

2 . Gain Equation 

A(k) = P(k|k)(}) (k+l,k)'^p“^(k+l|k) (12B) 



3. Covariance Equation 

P(kjn) = P(k|k)+A(k) [p (k+l|n) - P (k+l|Tc)J A(k)'^ (13B) 

The covariance equation is not used in the computation of 
the smoothed estimate of X(k|n) or filter gain A(k) , so it 
was not utilized in the program. 

First the values of the gain matrix A, are computed. 
Using the notation PIN=P ^ (12B) becomes 



All A12 
A21 A22 



Pll P12 
P12 P22 



1 0 
T 1 



PINll PINT2 
PIN12 PIN22 



(14B) 



where P(k|k) and P(k+l|k) are the covariance terms from the 
optimal filter equations and the fact that P12=P21 is 
utilized. 
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Again letting E(k) = X(k+l|n) - H (k ) <}> (k+1 1 k) X (k | k) , 
(llB) becomes 

X(k|n) = X(k|k) + A(k)E(k) (15B) 

and (IIB) is written in the notation used in the program as 



"SLAPSM 




SLAD ~ 




All 


A12 




= 




+ 






VELNDSM 




_VELND 




_A21 


A22_ 



and 



SLODSM 




SLOD 






= 




+ 


VELEDS 




_VELED_ 





[eladi] 



(16B) 



All A12 



I^ELONlJ 



(17B) 
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APPENDIX C 



DERIVATION OF THE VECTOR METHOD 
POSITION LOCATING ALGORITHM 

This algorithm is divided into three basic sections; 

(A) computation of normal vectors to the bearing plane, (B) 
computation of bearing vectors, and (C) computation of the 
target position vector. 

A. COMPUTATION OF THE NORMAL VECTOR TO THE BEARING PLANE 
The normal vector of the bearing planes are computed as 

described in Section II, D, using the aircraft latitude and 
longitude (<|),0), and the DF bearing angle a. 

The bearing plane has the equation dxx + dyy + dzz = 0. 
The normal vector, N, can be written in the form 

N = dxi + dyj + dzk (1C) 

where i,j,k are the iinit base vectors in the x,y,z 
directions. The components dx, dy, and dz, of normal vector 
N correspond to the coefficients foxind from (27) . That is 

dx = -sin a sin0. - cos a cos 0 sin <}> (2C) 

dy = sin a cos 0 - cos a sin0 sin(j) (3C) 

dz = cos a cos (j) (4C) 

B. COMPUTATION OF BEARING VECTOR 

Let SI(x,y,z) = xl + yj + zk denote the aircraft position 
vector. The cross product of SI and N produce the vector 
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perpendicular to the plane of both SI and N which is the 
bearing vector D(I), thus 



D(I) - SI X N 



1 j k 

X y z 

dx dy dz 



(5C) 



so that D(I) = A(I)i + B(I)j + C(I)k, 1=1,2, where 



A = yxDZ-zxDY 
B=zxDX-xxDZ 
C = xxDY-yx DX. 



(6C) 

(7C) 

(8C) 



Then each of the vectors is normalized to determine the 
length of the unit vector by dividing by D where 



D 




2 2 
+ B + C 



(9C) 



C. COMPUTATION OF THE TARGET POSITION VECTOR 

The two bearing vectors D(l) and D(2) are cross multi- 
plied to find the x,y,z coordinates of the target vector. 
So 





X 


y 


z 






X = D(l) X D(2) = 


A1 


B1 


Cl 


• 


(IOC) 




A2 


B2 


C2 






The algorithm for finding 


the 


target 


position vector 


is 


therefore 












XI = B1 X C2 - B2 


X Cl 








(IIC) 


X2 = A2 X Cl - A1 


X C2 




X 




(12C) 


X3 = A1 X B2 - A2 


X B1 


• 






(13C) 
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This vector is normalized to a unit vector with one unit 
being the radius of the earth. 

To find the latitude and longitude coordinates of the 
target position the following equations are used 



TLAD 



tan 



-1 



X3 



2 2 
XI + X2 



(14 ) 



TLOD 




(15 ) 



D. EXAMPLE OF VECTOR METHOD FOR LOCATING TARGET POSITION 

A DF bearing of 30 degrees is taken when the aircraft is 
at latitude 30 degrees north and longitude 45 degrees east. 

A second DF bearing of 60 degrees is taken from the same 
emitter when the aircraft is at 31 degrees north and 45 
east. 

1. First find the normal vector to the bearing plane by 
substituting the values of 4> r and a into (2C) through 

(4c) . 



DX = 


-sin30 


sin45 


- cos30 cos45 sin30 = 


-.6597 


DY = 


sin30 


cos45 - 


cos30 sin45 sin30 = 


.0473 


DZ = 


cos30 


cos30 = 


.750 





2. Using (21) through (23) find the x,y, and z com- 
ponents of the aircraft position vector. 

X = cos30 cos45 = .6123 
y = cos30 sin45 = .6123 
z = sin30 = .500 
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3. Next find the bearing vector, D(I), which is the 
cross product of the aircraft position vector and the normal 



to the bearing plane, using (6C) through (8C) . 

A1 = .6123 X .750 - .50 x .0473 = .4356 
B1 = .50 X (-.6597) - .6123 x .750 = -.7872 
Cl = .6123 X .0473 - .6123 x (-.6597) = .4329 

4. Find the value of D that will normalize D(I) to a 
unit vector. Using (9C) 



Therefore, the bearing vector is already a unit vector. 

5. Similarly the corresponding values for the second 

bearing are: DX = .7944, DY = .4302, DZ = .42855, x = .6061, 

y = .6061, and z = .5150. 

6. Since the angle of ar.rival of the second DF bearing 
is larger than the angle of the first bearing, the second 
bearing must be crossed into the first to obtain the outward 
pointing position vector. Therefore from (9C) and (IIC) 
through (13C) 



D = ^.0877 + .0941 + .0682 = .50 

7. Find the longitude and latitude coordinates of the 
target position using (14C) and (15C) . 



D 




XI =. (-.6688) X .4329 - (-.7892) x .7422 = .2962 



X2 = .4356 X .7422 - .0381 x .4329 = .3068 



X3 = .0381 X (-.7892) - .4356 x (-.6031) = .2613 
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TLOD = ARCTAN (. 6136/. 5924) = 46.0 degrees 
TLAD = ARCTAN (.5224/. 8529) = 31.5 degrees 

The computer solution to this problem was TLOD = 46.01540 
and TLAD = 31.49590. 
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APPENDIX D 



DERIVATION OF EXTENDED KALMAN FILTER EQUAT IONS 



A. ERROR COVARIANCE EQUATION INITIALIZATION 

The ellipse described by the Pll and Dll terms in the 
angle filtering routine lies in the X'Y' coordinate system 
which is rotated counter-clockwise (90 - a) degrees from the 
XY coordinate system used in the Extended Kalman Filter. To 
determine the values of the axes of the ellipse in the XY 
coordinate system, the transformation T, described by (51) 
was utilized. 



T 



cosa -sina 
sina cosa 



(ID) 



Let the semi-major axis be A' = E[X' 

major axis be C' = E[Y' - Y']- Define Z 
T 

X = [A' C']/ then the error covariance 



A. 

- X ' ] , and the semi- 

= tX where 

matrix P, in the XY 



frame is 



P = e[^Z z"^j = T e[x x'^Jt'^. 

Writing this equation in matrix form yields 



(2D) 



Pll P12 
P12 P21 



cosa -sina 
sina cosa 



A' 



lC’j 



[a' c] 



cosa sina 
-sina cosa 



(3D) 



Carrying out the indicated matrix multiplications in (3D) 
produces (52) through (54) which are repeated here. 

Pll(KI) = (A sina) ^ + (C cosa) ^ (4D) 
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P12(KI) = sina cosa (A^ - C^) 



(5D) 

(6D) 



P22(KI) = (A cosa)^ + (C sina)^ 

B. LATITUDE AND LONGITUDE FILTER EQUATIONS 

The block diagram for the filter system used in subrou- 
tine Extend is shown in Fig. 1. As stated in Section III/ 
part F, the latitude and longitude filters are identical to 
the corresponding filters used in Subroutine Nav to compute 
the optimal aircraft position estimates. The recursion 
equations for these filters are derived in Appendix A with 
the variable names utilized in this subroutine being listed 
at the end of Appendix A. 



C. LINEARIZED MEASUREMENT EQUATIONS 

The extended Kalman filter recursion equations (36) 
through (40) are similar in form to the basic Kalman filter 
recursion equations on page , except that the observation 
matrix is a nonlinear transformation matrix M as defined by 
(35) where 





• 










M /I, \ 

M(k) = — 
9X 


X 


96 

[3Xt 


96 


= [dmx dmy] 


(7D) 



Taking partial derivatives of (31) yields 



DMX = 



96 

9X. 



(L^-L) cos L^ 



DMY = 



96 

9L 



T 



(L^-L)2 + (X^-X)2 cos^L^ 

-(X^-X) [(L^-L) sinL^ + coslJ 
(L^-L)2 + (X^-X)2 cos^L^ 



(8D) 



(9D) 
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These terms are computed numerically and substituted into 
equations (36) and (37) which are rewritten in matrix form 



as 



GX 

GY 

and 



Pll P12 
P12 P22 



DMX 






[jDMX DMY 



0 



Pll P12 
P12 P22 



DMX 

DMY 



-1 



+ R 



(lOD) 



Pll P12 




1 0 




Pll P12 


_P12 P22_^ 




_0 1 _ 




_P12 P22_ 


k+l|k 




klk 



1 0 
0 1 



Qll Q12 
Q12 Q22 



(IID) 



Equation (38) is then substituted into (lOD) ; however, the 
fact that the ([) matrix is the identity matrix considerably 
simplifies the recursion equations since they are no longer 
dependent on the sampling interval T(k). Since the gain 
terms are computed as a function of the nonlinear terms DMX 
and DMY, it is essential to have the correct units for the 
error term ER(k). In this case the units of gain are not 
dimensionless but degrees per radian, so the error term 
must be given in radians to update the target position 
estimates in degrees of latitude and longitude. 

Equation (40) is substituted into (39) and written in 
the notation used in the program is 



XTDl(k) = XTD(k) + GX(k)ER(k) 



(12D) 



and 



YTDl(k) = YTD(k) + GY(k)ER(k). 



(13D) 



APPENDIX E 



MONTE CARLO SIMULATION ERROR ANALYSIS 



ESTIMATED AIRCRAFT POSITION ERROR IN DEGREES LATITUDE 
LATITUDE LONGITUDE 



RUN 


NOISE ADDED 


SMOOTHED 


NOISE ADDED 


SMOOTHED 


a 


TO POSITION 


POSITION 


TO POSITION 


POSITION 






ERROR 




ERROR 


1 


-0.921E-04 


-0.708E-04 


0. 143E-03 


0.117E-03 


2 


0.775E-05 


0.388E-04 


0.125E-03 


0.103E-03 


3 


0.748E-04 


0. 958E-04 


-0.378E-04 


-0.610E-04 


4 


-0 .403E-04 


-0.200E-04 


0.236E-03 


0.213E-03 


5 


0.883E-04 


0.114E-03 


-0.152E-03 


-0. 182E-03 


6 


-0.785E-04 


-0. 548 E- 04 


0.158E-04 


-0.125E-04 


7 


0.348E-04 


0. 578E-04 


-0.670E-04 


-0. 918E-04 


8 


0. 196E-03 


0.226E-03 


0 .255E-04 


-0.775E-05 


9 


-0.723E-04 


-0.5C3E-04 


-0. 153E-04 


-0.333E-04 


10 


-0.138E-03 


-0 .115E-03 


0.405E-04 


0.775E-05 


11 


-0.119E-03 


-0. 886E-04 


0.225E-03 


0.199 E-03 


12 


-0.580E-04 


-0.325E-04 


0.725E-04 


0.483E-04 


13 


0.643E-04 


0.873E-04 


0 .485E-04 


0.901E-05 


14 


0.758E-04 


0. 1C8E-03 


0.625E-04 


0.383E-04 


15 


0.104E-03 


0.128E-03 


0.455E-04 


0.130E-04 


16 


-0. 172E-03 


-0.146E-03 


-0.998E-04 


-0.131E-03 


17 


-0.948E-04 


-0. 718E-04 


-0.833E-04 


-0.105E-03 


18 


0.158E-03 


0 .180E-03 


-0.132E-03 


-0. 152E-03 


19 


0.543E-04 


0. 765E-04 


-0.713E-04 


-0 .923E-04 


20 


0.926E-04 


0. 122E-03 


0. 124E-03 


0.873E-04 


21 


-0.758E-04 


-0.505 E-04 


0 .295E-04 


0.926E-05 


22 


-0.888E-04 


-0. 7C3E-04 


0.113E-03 


0.926E-04 


23 


-0 .588E-04 


-0 . 368E-04 


0. 107E-03 


0.840E-04 


24 


0. 184E-03 


0.207E-03 


0.338E-04 


0.750E-05 


25 


-0. 163E-03 


-0. 142E-03 


0. 263E-04 


0.875E-05 


26 


0.393E-04 


0 . 553E-04 


0. 140E-04 


-0.625E-05 


27 


-0. 199E-03 


-0. 175E-03 


0.132E-03 


O.llOE-03 


28 


0.264E-03 


0. 289E-03 


-0. 108E-03 


-0.133E-03 


29 


0. 166E-03 


0. 190E-03 


0.620E-04 


0.368E-04 


30 


-0.208E-03 


-0. 179E-03 


0.238E-04 


-0.700E-05 


31 


0.685E-04 


0.926E-04 


-0.650E-05 


-0.320E-04 


32 


-0. 133E-03 


-0.111 E-03 


-0 .153E-03 


-0.178E-03 


33 


-0. lOOE-05 


0.243E-04 


0. 535E-04 


0.295E-04 


34 


-0.258E-04 


-0 .125E-05 


-0.475E-04 


-0.670E- 04 


35 


0. 575E-05 


0.385E-04 


0. 112E-03 


0.833E-04 


36 


0.112E-03 


■ 0. 135E-03 


-0. 192E-03 


-0.229E-03 


37 


-0.658E-04 


-0 .375 E-04 


-0.150E-03 


-0. 173E-03 


38 


0.315E-04 


0. 545E-04 


-0. 170E-03 


-0.201E-03 


39 


0.245E-04 


0.383E-04 


-0.465E-04 


-0. 728E-04 


40 


0.285E-04 


0.448E-04 


0 .114E-03 


0.916E-04 


41 


0.475E-04 


0.713E-04 


-0.242E-03 


-0.270E-03 


42 


-0.588E-04 


-0 .300E-04 


0.490E-04 


0.253E-04 


43 


0.145E-03 


0. 174E-03 


-0.307E-11 


-0.288E-04 


44 


0.162E-03 


0. 189E-03 


-0.120E-03 


-0. 144E-03 


45 


0.795E-04 


0.1 06 E-03 


0.107E-03 


0.745E-04 






AVERAGE 


ERRORS 






NOISE 


MEAN SQUARE 


ERROR 


MEAN SQUARE 






NOISE 




ERROR 


ATITUDE 










0.814E-05 


0. 126E-07 


0.325E-04 


0. 137E-07 


ONGITUDE 










0.552E-05 


0.119E-07 


-0.205E-04 


0.124E-07 
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MONTE CARLO SIMULATION ERROR ANALYSIS 



ESTIMATED EMITTER POSITION ERROR IN NAUTICAL MILES 
EXTENDED KALMAN FILTER 







EMITTER it 


1 




EMITTER # 


2 


RUN 


DLATl 


DLONl 


DRNGl 


DLAT2 


DL0N2 


DRNG2 


1 


-0.13275 


-2.06057 


2.06484 


-0.26367 


-4.77378 


4.78105 


2 


0. 19501 


-0.20215 


0. 28088 


0.13458 


4.61521 


4.61717 


3 


-0 .41382 


-2.82782 


2.85794 


0.13458 


4.61521 


4.61717 


4 


7.08435 


15.22875 


16.79591 


0.13458 


4.61521 


4.61717 


5 


0.34973 


1.51996 


1.55968 


3.05878 


17. 13541 


17.40627 


6 


0.52734 


2.15016 


2.21388 


-0.05127 


-6.19852 


6.19873 


7 


2.55524 


5.96270 


6.48715 


-0.05127 


-6.19852 


6.19873 


8 


-0.41016 


-6.43056 


6.44363 


-0.05127 


-6.19852 


6 .19873 


9 


0.48523 


1 .84157 


1.90442 


0.76172 


-10.95459 


10.98104 


10 


0.36530 


-0.51840 


0.63417 


0.76172 


-10.95459 


10.98104 


11 


-0.01373 


-0.26877 


0. 26912 


0.76172 


-10.95459 


10.98104 


12 


-0.24353 


-2 .94039 


2.95045 


3.13110 


9.47674 


9.98060 


13 


-0.38086 


-4.55913 


4.57501 


0.79010 


-10.04171 


10.07274 


14 


0.46967 


1.21750 


1.30495 


2 .88940 


17.06227 


17.30519 


15 


-0.51819 


-3.60121 


3.63830 


0.58685 


3.54069 


3.58900 


16 


0. 15106 


-1.57663 


1.58385 


2.13318 


7.10832 


7.42150 


17 


4.17938 


9.80282 


10 .65657 


-0.07782 


-4.01022 


4.01097 


18 


-0.48706 


-2.14326 


2. 19791 


-0.07782 


-4.01022 


4.01097 


19 


2.39960 


4.55683 


5.15003 


1.30096 


-14.17046 


14.23006 


20 


1. 50421 


5. 11 581 


5.33237 


0 .28839 


-9.11035 


9.11491 


21 


-0.06042 


-2.97637 


2.97699 


3.81042 


-19.66084 


20.02667 


22 


1.65253 


3.94042 


4.27291 


0.65552 


-9.76153 


9.78352 


23 


12.78076 


21.09802 


24.66727 


0.47241 


0.25247 


0.53564 


24 


0.21240 


-0.97324 


0.99615 


1.27991 


1.17305 


1.73615 


25 


1. 19476 


3.26888 


3. 48038 


0.67291 


-7. 58709 


7.61687 


26 


-0. 17303 


-4.62192 


4.62516 


0 .67291 


-7.58709 


7.61687 


27 


5.29816 


9.67111 


11. 02728 


-0.33142 


-0.94 059 


0 .99727 


28 


-0.15198 


-7.01022 


7.01186 


0 .08972 


3.94325 


3.94427 


29 


0.15839 


-1.37141 


1.38053 


-0.05310 


-8.21902 


8.21919 


30 


1.51886 


5.09590 


5.31744 


-0,05310 


-8.21902 


8. 21919 


31 


0.22797 


2.07282 


2.08532 


1.58752 


-12.84886 


12.94656 


32 


5.62866 


8.69098 


10.35447 


0.97229 


5.07089 


5.16326 


33 


0.51544 


0.75654 


0.91544 


0.44403 


-8.21594 


8.22793 


34 


3.34991 


8.26371 


8.91688 


-0.39551 


-5 .82290 


5.83631 


35 


-0.09430 


-2. 87224 


2. 87378 


-0.421 14 


-4.47744 


4.49720 


36 


3.70972 


8.64734 


9.40949 


-0.42114 


-4.47744 


4.49720 


37 


1.31470 


3.19997 


3. 45951 


0.28290 


-5.10475 


5 .11258 


38 


-0.38177 


-3.539 18 


3.55971 


0. 02014 


-6.37016 


6.37020 


39 


2.58820 


5.81645 


6.36630 


0.33600 


-8.64621 


8.65274 


40 


-0.57129 


-6.08063 


6.10740 


1.60767 


-14.08425 


14. 17571 


41 


-0.13458 


-1 .26881 


1.27592 


2.94250 


13.34225 


13.66287 


42 


4. 53186 


7. 77.977 


9.00348 


3.24005 


10.32419 


10.82067 


43 


4.18488 


9.18335 


10.09193 


-0.04852 


-6 .79120 


6.79137 


44 


-0.40009 - 


•10.54251 


10. 55010 


2.35657 


8.65006 


8 .96532 


45 


-0,07507 


-1.51843 


1. 52029 


0. 31036 


-9.50906 


9.51413 


46 


-0.37354 


-5.63268 


5.64505 


2.11945 


-13.57008 


13.73460 


47 


-0.47241 


-3.34622 


3.37940 


0.07599 


-2.16906 


2.17039 


48 


2.00592 


7.79815 


8.05201 


0.19043 


-7.81723 


7.81955 


49 


0.11353 


-0.30629 


0.32665 


0.19043 


-7.81723 


7.81955 


50 


-0.00732 


-0.84077 


0.84080 


-0.10895 


-1.01371 


1.01955 






AVERAGE 


ERROR IN NAUTICAL MILES 






AVERAGE 


AVERAGE 


AVERAGE 


AVERAGE 


AVERAGE 


AVERAGE 




LATITUDE LONGITUDE RANGE 


LATITUDE LONGITUDE 


RANGE 


RUNS ERROR 


ERROR 


ERROR 


ERROR 


ERROR 


ERROR 


50 


1.53497 


4.65418 


4.98781 


0.87208 


7.78420 


7.87609 
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MONTE CARLO SIMULATION ERROR ANALYSIS 
ESTIMATED EMITTER POSITION ERROR IN NAUTICAL MILES 
BEARING ANGLE-OF-ARRI VAL FILTER 



EMITTER # 1 EMITTER # 2 



RUN 


DL ATI 


DLON 1 


DRNGl 


DLAT2 


DL0N2 


DRNG2 


1 


-0.77362 


-0.96022 


1 .23309 


-0.18036 


-0 .03156 


0.18310 


2 


-0.81299 


0.41349 


0.91210 


-0.60333 


1.63641 


1.74409 


3 


-0.70770 


-1.31169 


1.49043 


0.12726 


1.13456 


1.14167 


A 


1.20026 


2.43424 


2.71406 


-0.60242 


1 .38549 


1 .51079 


5 


0.11078 


-0.15468 


0.19025 


-0.24078 


2.70863 


2.71931 


6 


-0.25635 


-1.06206 


1 .09256 


-0 .80383 


-2.49311 


2.61949 


7 


0.52826 


1.71829 


1. 79766 


0.97595 


-0.94367 


1.35757 


8 


-1.23230 


-1.55595 


1.98483 


-0.13092 


2.88797 


2.89094 


9 


0.27466 


-0.41732 


0.49959 


-1 .48041 


-1.51403 


2.11752 


10 


0.41016 


-1.46790 


1.52412 


-0.29022 


3.01959 


3.03351 


1 1 


0.19409 


-2.42505 


2.43281 


0.66650 


1.50633 


1.64720 


12 


-0.81116 


-0.92500 


1. 23028 


0. 17944 


-0.24323 


0.30226 


13 


-1.43005 


-1.22133 


1.88061 


-0.69214 


-0.01770 


0.69237 


14 


0. 14740 


0.57736 


0.59588 


-0.37170 


2.27605 


2.30620 


15 


-0.54565 


-2.34542 


2.40805 


-0.28290 


-0.16395 


0.32697 


16 


-0.0421 1 


-0.28332 


0.28643 


-0.74707 


0.21398 


0.77711 


17 


1.28174 


1.62793 


2.07196 


-0.36072 


-2.23910 


2.26797 


18 


-1.21674 


-C. 90279 


1.51508 


1.39160 


3.39214 


3.66649 


19 


-0.21698 


-1 .59118 


1.60590 


-1.61499 


-2.44308 


2.92862 


20 


0. 74249 


0. 19143 


0. 76677 


-1.17279 


-0.54650 


1.29387 


21 


-0.14282 


-0.58731 ■ 


0.60443 


-0.93842 


-3.95942 


4.06910 


22 


0.70129 


-1.15548 


1.35165 


-0.60974 


-0.51648 


0.79908 


23 


0.56030 


-0.97171 


1. 12167 


-0.95673 


0.32944 


1.01186 


24 


-0.74799 


1.89134 


2.03388 


-0.66742 


-1.18921 


1.36370 


25 


-0.08514 


0.82162 


0.82602 


-0.36896 


-2.34686 


2.37569 


26 


-0.91919 


-1.17998 


1.49575 


0.76721 


0.91673 


1.19541 


27 


0.3781 1 


0.20215 


0.42876 


1.17462 


-1.32930 


1.77391 


28 


-0.92468 


-1.51690 


1.77652 


0.57404 


2.32223 


2.39213 


29 


-0.17303 


-0.72744 


0.74774 


-0,45593 


-2.55084 


2. 59 126 


30 


0.8853 1 


1.737A3 


1.94999 


0.95123 


5.42342 


5.50620 


31 


-0.08331 


0.60492 


0.61063 


-1.28357 


-2.41537 


2.73524 


32 


1.21307 


-1.48704 


1.91907 


-0.70404 


1 .98664 


2.10770 


33 


0.51270 


-0.83158 


0.97692 


-0.38635 


-1.90274 


1.94156 


34 


0.58319 


1.59501 


1.69828 


0.63263 


-1.83654 


1.94245 


35 


-0.76630 


-0.14625 


0.78013 


-1.66718 


2.10517 


2.68537 


36 


0.56854 


1.87450 


1.95882 


0. 11444 


4. 54440 


4.54584 


37 


0.43396 


-2.07665 


2.12150 


-0.75531 


-2.24449 


2.36817 


38 


-0.95398 


-0.95486 


1.34975 


-0. 61249 


-1.45322 


1.57702 


39 


0.62256 


-1.19377 


1.34635 


0.05219 


-2.86488 


2.86536 


40 


-1.44653 


-1.89823 


2.38658 


-1.62140 


-2 .77405 


3.21315 


41 


-0.29388 


-0.91657 


0.96254 


0. 19501 


2.32531 


2.33347 


42 


0.32593 


1.00846 


1.05982 


-0.05127 


1.33546 


1.33 644 


43 


1.08032 


0.27030 


1. 11362 


-1.89514 


-0.38101 


1 .93306 


44 


-1 .64886 


-2.81710 


3.26417 


-0.34149 


2.46309 


2.48665 


45 


-1.29272 


0.55285 


1 .40598 


-1.14624 


-1.53096 


1.91252 


46 


-0.74982 


-2.17236 


2.29813 


0.02655 


-1.00448 


1.00483 


47 


-1.05377 


-0.67843 


1 .25328 


-0.94391 


-0.78357 


1.22676 


48 


1.37787 


-0.28638 


1.40732 


-0.77545 


-3.45987 


3.54571 


49 


-0.39276 


-0.20368 


0.44243 


0.67017 


3.63768 


3.69889 


50 


-0.39276 


0.50614 


0.64066 


-0 . 18494 


0.78973 


0.81109 






AVERAGE ERROR IN NAUTICAL MILES 






AVERAGE 


AVERAGE 


AVERAGE 


AVERAGE 


AVERAGE 


AVERAGE 




LATITUDE 


; LONGITUDE 


RANGE 


LATI TUDE 


LONGITUDE 


RANGE 


RUNS 


; ERROR 


ERROR 


ERROR 


ERROR" 


- ERROR 


ERROR 


50 


0.68492 


1.12906 


1.39129 


0.68879 


1.87039 


2.09753 



75 



K 

1 

2 

3 

4 

5 

6 

7 

8 

9 

10 

11 

12 

13 

14 

15 

16 

17 

18 

19 

20 

21 

22 

23 

24 

25 

26 

27 

28 

29 

30 

31 

32 

33 

34 

35 

36 

37 

38 

39 

40 

41 

42 

43 

44 

45 

46 

47 

48 

49 

50 

51 

52 

53 

54 

55 

56 

57 

58 

59 

60 

61 



LISTING OF EMITTER TARGET DATA 



TIMET 


FREO 


PRF 


PW 


BRNGD 


THETAD 


100.0 


1197.0 


150.0 


3 .50 


105 .98349 


106.81114 


106.0 


1212.0 


250. 0 


3.00 


123.17577 


124. 30956 


112.0 


1197.0 


150 .0 


3.50 


104.01610 


104.36736 


118.0 


1212.0 


250. 0 


3.00 


121.91071 


122.41992 


124.0 


1197.0 


150.0 


3.50 


102.01436 


102.41859 


130.0 


1212 .0 


250.0 


3 .00 


120.60915 


121.18193 


136.0 


1197.0 


150. 0 


3.50 


99.98351 


100.68506 


142.0 


1212.0 


250.0 


3.00 


119.27164 


118.74664 


148.0 


1197.0 


150.0 


3 .50 


97.92696 


96.78751 


154.0 


1212.0 


250. 0 


3.00 


117.89893 


118.73015 


160.0 


1197 .0 


150.0 


3.50 


95.84862 


94.37448 


166.0 


1212.0 


250. 0 


3.00 


116.49051 


116.33717 


172.0 


1197.0 


150.0 


3. 50 


93. 75478 


94. 24924 


1 78.0 


1212.0 


250.0 


3.00 


115.04587 


116.48721 


184.0 


1197.0 


150. 0 


3.50 


91.65182 


92.49257 


190.0 


1212.0 


250.0 


3.00 


113.56721 


1 13.94238 


196.0 


1197.0 


150.0 


3 .50 


89 .54355 


90 . 58488 


202.0 


1212.0 


250. 0 


3.00 


112.05394 


1 12.42679 


208.0 


1197.0 


150.0 


3.50 


87.43718 


85. 53748 


214.0 


1212.0 


250.0 


3 . 00 


110.50731 


109.75629 


220.0 


1 1 97. 0 


150.0 


3.50 


85.33707 


87.01108 


226.0 


1212 .0 


250.0 


3.00 


108.92969 


108.96266 


232.0 


1197-0 


150. 0 


3.50 


83.24927 


83.44542 


238-0 


1212.0 


250.0 


3.00 


107.32155 


108.41565 


244.0 


1197.0 


150.0 


3 .50 


81.18033 


81.18315 


2 50.0 


1212.0 


250. 0 


3.00 


105.68427 


105. 95073 


256.0 


1197.0 


150.0 


3.50 


79. 13434 


79.59174 


262.0 


1212.0 


250. 0 


3 .00 


104.02003 


104.99403 


2 68.0 


1197.0 


150. 0 


ri K n 


77.11496 


77. 19061 


2 74.0 


1212 .0 


250.0 


3.00 


102.33223 


103.68779 


280. 0 


1197.0 


150. 0 


3. 50 


75. 12862 


73.77927 


286.0 


1212.0 


250.0 


3.00 


100. 62157 


100.01122 


2 92. 0 


1197.0 


150.0 


3.50 


73 . 17722 


72.55504 


298.0 


1212. 0 


250. 0 


3.00 


98.89243 


97.91229 


304.0 


1197.0 


150.0 


3.50 


71.26514 


72.24512 


310.0 


1212.0 


250.0 


3.00 


97.14586 


96.42537 


316.0 


1197. 0 


150.0 


3.50 


69.39635 


68. 22856 


322.0 


1212 .0 


250.0 


3 .00 


95.38602 


94. 80276 


328.0 


1197.0 


150- 0 


3. 50 


67.57230 


67.65929 


334.0 


1212.0 


250.0 


3.00 


93.61652 


93.63611 


340.0 


1197.0 


150.0 


3 .50 


65 .79401 


66.59315 


346.0 


1212.0 


250 .0 


3 .00 


91.84023 


89. 98112 


352.0 


1197.0 


150. 0 


3.50 


64. 06415 


63.11497 


358.0 


1212.0 


250.0 


3.00 


90. 05968 


91. 48303 


3 64.0 


1197.0 


150.0 


3.50 


62.38416 


60.46066 


370.0 


1212.0 


250. 0 


3.00 


88.27945 


87.50397 


376.0 


1197.0 


150.0 


3.50 


60.75365 


61.14169 


382. 0 


1212.0 


250.0 


3.00 


86.50214 


87.24391 


388.0 


1197.0 


150.0 


3.50 


59. 17412 


57. 07373 


394.0 


1212 .0 


250.0 


3 .00 


84.73131 


85.86865 


400.0 


1197.0 


150. 0 


3.50 


57.64409 


56.69685 


406.0 


1212.0 


250.0 


3.00 


82.97147 


84.63478 


412.0 


1197.0 


150.0 


3.50 


56.16422 


57. 10556 


418.0 


1212.0 


250. 0 


3.00 


81.22481 


81.01143 


424.0 


1197.0 


150. 0 


3.50 


54. 73453 


55. 17111 


430.0 


1212.0 


250.0 


3.00 


79 .49355 


80.80753 


436.0 


1197.0 


150. 0 


3.50 


53.35355 


54.66557 


442 .0 


1212 .0 


250.0 


3.00 


77.78148 


77.29852 


448.0 


1197.0 


150.0 


3.50 


52.01973 


52.38834 


454.0 


12 12.0 


250. 0 


3.00 


76.09212 


76. 34935 


4 60.0 


1197.0 


150.0 


3.50 


50.73331 


52.29285 



76 



AIRCRAFT NAVIGATION COMPUTER DATA 



ACTUAL 
LAT ITUDE 



1 


33.5000 


2 


33.4833 


3 


33.4667 


4 


33.4500 


5 


33.4333 


6 


33.4167 


7 


33.4000 


8 


33.3833 


9 


33.3667 


10 


33.3500 


11 


33.3333 


12 


33.3167 


13 


33.3000 


14 


33.2833 


15 


33.2667 


16 


33.2500 


17 


33.2333 


18 


33.2167 


19 


33.2000 


20 


33.1 833 


21 


33.1667 


22 


33.1500 


23 


33.1333 


24 


33. 1167 


25 


33.1000 


26 


33. 0333 


27 


33.0667 


28 


33.0500 


29 


33.0333 


30 


33.0167 


31 


33.0000 


32 


32.9833 


33 


32.9667 


34 


32.9500 


35 


32.9333 


36 


32 .9167 


37 


32.9000 


38 


32.8833 


39 


32.8667 


40 


32.8500 


41 


32.8333 


42 


32.8167 


43 


32.8000 


44 


32.7833 


45 


32 .7667 


46 


32.7500 


47 


32.7333 


48 


32.7167 


49 


32.7000 


50 


32.6833 


51 


32.6667 


52 


32.6500 


53 


32.6333 


54 


32.6167 


55 


32.6000 


56 


32.5833 


57 


32.5667 


58 


32.5500 


59 


32. 5333 


60 


32.5167 


61 


32.5000 



NOI SY 
LATITUDE 



33.5007 
33.4841 
33.4679 
33.4505 
33.4332 
33.4167 
33 .3999 
33.3836 
33.3667 
33.3498 
33.3322 
33.3166 
33.2995 
33.2834 
33 .2674 
33.2480 
33.2327 
33.21 55 
33.1997 
33.1831 
33. 1673 
33.1494 
33. 1328 
33.1172 
33 .0992 
33.0832 
33.0660 
33.0490 
33. 0329 
33.0162 
32.9988 
32.9831 
32.9655 
32.9501 
32.9315 
32.9183 
32.8998 
32.8841 
32 . 8688 - 
32.8509 
32.8338 
32. 8158 
32.7994 
32.7833 
32.7688 
32.7488 
32.7322 
32.7177 
32.7002 
32.6824 
32.6661 
32.6497 
32.6346 
32.61 71 
32.6000 
32.5843 
32.5660 
32.5497 
32.5330 
32.5165 
32.4999 



SMOOTHED 

LATITUDE 



33.5007 
33.4841 
33.4676 
33.4504 
33.4333 
33.4166 
33.4001 
33.3834 
33. 3666 
33.3495 
33. 3328 
33 . 3162 
33 .2999 
33.2835 
33.2662 
33.2491 
33.2322 
33.2158 
33. 1996 
33.1833 
33 . 1665 
33. 1497 
33.1332 
33 . 1 164 
33.0997 
33.0828 
33.0659 
33.0493 
33 . 0327 
33.0159 
32.9993 
32.9826 
32.9660 
32.9491 
32.9331 
32.9167 
32.9005 
32. 8846 
32.8681 
32 . 8510 
32.8334 
32.8162 
32.7998 
32.7839 
32.7668 
32. 7496 
32.7332 
32.7168 
32.6998 
32.6828 
32.6662 
32.6502 
32.6338 
32.6172 
32.6005 
32.5835 
32. 5665 
32.5496 
32.5330 
32.5164 
32.4999 



ACTUAL 

LONGITUDE 



- 118.5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118. 5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118 . 5000 
- 118.5000 
- 11 8. 5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118,5000 
- 118,5000 
- 118.5000 
- 118.5000 
- 118.5000 
-118 .5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118. 5000 
- 118.5000 
- 118.5000 
- 118.5000 
-118 .5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118 .5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118.5000 
-118 .5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118. 5000 
- 11 8. 5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118.5000 
- 118.5000 



NOI SY 
LONGITUDE 



- 118.5012 
- 118.5003 
- 118,5019 
- 118.4985 
- 118.5007 
- 118.4997 
- 118.4992 
-118 .5006 
- 118.5006 
- 118.4994 
- 118.5007 
- 118.4985 
-118 .5010 
- 118.5002 
- 118.5005 
- 118.5011 
- 118.5001 
- 118.4986 
- 118. 5004 
- 118.4985 
- 118.5005 
- 118.5007 
- 118.5011 
- 118.4991 
- 118.5005 
- 118.4996 
- 118.5010 
- 118.4995 
-118 .5000 
- 118.4995 
-118 .5000 
- 118.4996 

- 118.4992 
- 118.4997 
- 118.5008 
- 118.5013 
- 118.5005 
- 118.4993 
- 118.4990 
- 118.5003 
- 118.5013 
- 118.5008 
- 118.4998 
- 118.4998 
- 118.5001 
- 118.5016 
- 118.5006 
-118 .5001 
- 118.4993 
- 118.5002 
- 118.4997 
- 118.5001 
- 118.4998 
- 118.4998 
- 118.4996 
- 118.5000 
-118 .5007 

- 1 . 18.4997 
- 118.4996 
- 118.5004 
- 118.5004 



SMOOTHED 

LONGITUDE 



- 118.5011 
- 118.5003 
- 118.5008 
- 118.4999 
- 118.4999 
- 118.4998 
- 118.4997 
- 118.5001 
- 118.5003 
- 118.5000 
- 118.4999 
- 118.4996 
- 118.5001 
- 118.5004 
- 118.5006 
- 118.5007 
- 118.5001 
- 118.4995 
- 118.4995 
- 118.4994 
- 118.5000 
- 118. 5005 
- 118.5006 
- 118.5000 
- 118. 5000 
- 118.5000 
- 118.5002 
- 118.5000 
- 118.4998 
- 118.4997 
- 118.4997 
- 118.4996 
- 118.4995 
- 118.4998 
- 118.5005 
- 118.5009 
- 118.5005 
- 118.4997 
- 118.4994 
- 118.5000 
- 118.5007 
- 118.5007 
- 118.5002 
- 118.5000 
- 118 . 5002 
-118 .5008 
- 118.5007 
- 118.5002 
- 118.4997 
- 118.4998 
- 118.4998 
- 118.4999 
-11 8.4999 
- 118.4998 
- 118.4998 
- 118.5000 
- 118.5002 
- 118 . 5000 
- 118.4999 
- 118.5002 
- 118.5004 
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K 

1 

2 

3 

4 

5 

6 

7 

8 

9 

10 

11 

12 

13 

14 

15 

16 

17 

18 

19 

20 

21 

22 

23 

24 

25 

26 

27 

28 

29 

30 

31 

32 

33 

34 

35 

36 

37 

38 

39 

40 

41 

42 

43 

44 

45 

46 

47 

48 

49 

50 

51 

52 

53 

54 

55 

56 

57 

58 

59 

60 

61 



NAVIGATION DATA FILTER PARAMETERS 



SGI 


SG2 


SPll 


SP12 


SP22 


T 


0.0 


0 .0 


1.00000 


0.0 


1.00000 


0.0 


0.99999 


0.16216 


37.00000 


6.00000 


1.00004 


6.00 


0.99957 


0 . 1 6646 


0.97585 


0.16251 


0. 02711 


6 . 00 


0.89002 


0.11174 


0.00337 


0.00042 


0.00009 


6.00 


0.86395 


0. 10864 


0.00265 


0.00033 


0.00008 


6.00 


0.86253 


0.10906 


0.00261 


0.00033 


0.00008 


6 . 00 


0.86251 


0.10903 


0.00261 


0 .00033 


0.00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6 . 00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0 . 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0. 10901 


0.00261 


0.00033 


0. 00008 


6 . 00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6 . 00 


0. 86246 


0.10901 


0.00261 


0 .00033 


0.00008 


6.00 


0. 86246 


0.10901 


0.00261 


0.00033 


0. 00008 


6 . 00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6 . 00 


0. 86246 


0.10901 


0. 00261 


0.00033 


0.00008 


6.00 


0.86246 


0. 10901 


0.00261 


0. 00033 


0. 00008 


6 . 00 


0.86246 


0. 10901 


0.00261 


0.00033 


0.00008 


6.00 


0. 86246 


0 . 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6 . 00 


0. 86246 


0.10901 


0.00261 


0.00033 


0.00008 


6.00 


0. 86246 


0.10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6 . 00 


0. 86246 


0 . 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0. 10901 


0.00261 


0.00033 


0. 00003 


6 . 00 


0.86246 


0.10901 


0 .00261 


0.00033 


0.00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0. 00008 


6 . 00 


0.86246 


0.10901 


0.00261 


0 .00033 


0.00008 


6.00 


0. 86246 


0.10901 


0.00261 


0.00033 


0. 00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6.00 


0. 86246 


0. 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6 . 00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0 . 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6 . 00 


0. 86246 


0.10901 


0.00261 


0 .00033 


0.00008 


6.00 


0. 86246 


0. 10901 


0.00261 


0.00033 


0. 00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00003 


6 . 00 


0. 86246 


0. 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0. 10901 


0.00261 


0.00033 


0. 00008 


6 . 00 


0.86246 


0. 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0. 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6 . 00 


0 . 86246 


0.10901 


0.00261 


0 .00033 


0.00008 


6.00 


0. 86246 


0. 10901 


0.00261 


0.00033 


0. 00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6.00 


0 . 86246 


0 . 1 0901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0.10901 


0.00261 


0. 00033 


0. 00008 


6 . 00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6.00 


0. 86246 


0. 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0. 10901 


0.00261 


0.00033 


0.00008 


6.00 


0. 86246 


0.10901 


0.00261 


0.00033 


0. 00008 


6 . 00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0. 10901 


0.00261 


0. 00033 


0. 00008 


6.00 


0.86246 


0. 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0. 10901 


0.00261 


0.00033 


0.00008 


6.00 
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NAVIGATION DATA FILTER PARAMETERS 



K VELNO ELAT 



SLATD VELED ELON 



SLOND 



1 -0.00225 

2 -0.00225 

3 -0.00316 

4 -0.00290 

5 -0.00282 

6 -0.00288 

7 -0.00273 

8 -0.00256 

9 -0.00284 

10 -0.C0279 

11 -0.00284 

12 -0.00270 

13 -0.00279 

14 -0.C0273 

15 -0.00291 

16 -0.00278 

17 -0.00275 

18 -0.C0278 

19 -0.00281 

20 -0.00256 

21 -0.00298 

22 -0.C0276 

23 -0.00260 

24 -0.00277 

25 -0.00294 

26 -0.00262 

27 -0.00280 

28 -0.00278 

29 -0.00280 

30 -0.00274 

31 -0.00275 

32 -0.00282 

33 -0.00279 

34 -0.00277 

35 -0.00274 

36 -0.00272 

37 -0.00295 

38 -0.00280 

39 -0.00260 

40 -0.00280 

41 -0.00277 

42 -0.00274 

43 -0.00277 

44 -0.00285 

45 -0.00299 

46 -0.00265 

47 -0.C0270 

48 -0.00282 

49 -0.00277 

50 -0.00290 

51 -0.00271 

52 -0.00266 

53 -0.00287 

54 -0.00270 

55 -0.00295 

56 -0.00260 

57 -0.00283 

58 -0.00285 

59 -0.00263 

60 -0. 00278 

61 -0.00268 



0.0 

0.0 

-0 .00546 
0. 00235 
0.00075 
-0.00063 
0. 00140 
0.00162 
-0.00266 
0.00052 
-0.00050 
0. 00134 
-0.00089 
0.00055 
-0.00160 
0.00113 
0.00032 
-0.00029 
-0 .0003 1 
0.00233 
-0.00383 
0.00197 
0.00153 
-0.00163 
-0.00154 
0.00294 
-D .00165 
0.00017 
-0.00018 
0.00058 
-0.00006 
-0.00072 
0.00035 
0.00015 
0.00024 
0. 00024 
- 0.00212 
0.C0133 
0.00186 
-0 .00186 
0.00031 
0.00024 
-0.00027 
-0. 00067 
-0.00130 
0.00305 
-0. 00040 
-0.00116 
0.00047 
-0.00119 
0 .00172 
0. 00050 
-0.00189 
0.00150 
-0.00229 
0.00323 
- 0.00212 
-0. 00015 
0 .00200 
-0.00134 
0.00092 



33.49908 
33.48558 
33.47208 
33.44765 
33.43234 
33 .41608 
33.39821 
33.38303 
33.36908 
33.34970 
33.33340 
33.31590 
33.30086 
33.28333 
33. 26740 
33.24855 
33 .23280 
33.21657 
33.19962 
33.18245 
33. 16908 
33.14790 
33. 13301 
33. 11874 
33.10068 
33.08167 
33.06847 
33.05022 
33.03365 
33.01665 
33.00069 
32.98415 
32.96657 
32.95013 
32.93364 
32.91737 
32.90126 
32.88174 
32. 86606 
32.85205 
32.83360 
32.81725 
32.80098 
32.78409 
32.76642 
32.74736 
32.73405 
32.71751 
32 .69955 
32.68330 
32.66484 
32.65002 
32.63449 
32.61566 
32.60072 
32. 58102 
32.56819 
32.54936 
32.53214 
32.51805 
32.50023 



0.00003 
0. 00003 
- 0.00001 
0.00000 
- 0 . 00012 
0.00012 
- 0. 00010 
-0.00016 
0 .00015 
0. 00010 
0.00014 
-0.00008 
-0. 00005 
0.00006 
- 0.00012 
0.00003 
0.00014 
-0.00006 
- 0.00001 
- 0.00010 
- 0 . 00002 
0.00001 
0.00009 
-0.00004 
0 .00001 
-0. 00008 
0.00002 
0.00004 
0. 00003 
- 0.00011 
-0.00005 
0.00000 
0.00008 
0.00014 
- 0.00002 
0.00001 
-0. 00005 
0.00002 
-0.00018 
0.00008 
0.00007 
0.00005 
-0.00008 
- 0.00002 
- 0. 00000 
0.00005 
- 0.00002 
0.00011 
-0 .00007 
- 0. 00000 
0.00004 
-0.00003 
-0. 00016 
0.00008 
0.00005 
-0.00003 
-0 .00011 
- 0. 00001 
0.00006 
-0.00007 
0. 00007 



0.0 

0.00003 
-0.00023 
0.00011 
-0.00132 
0.00239 
-0.00224 
-0.00080 
0.00310 
-0.00029 
0.00061 
-0.00213 
0.00014 
0.00114 
-0.00185 
0.00139 
0.00130 
-0. 00195 
0.00046 
-0.00103 
0.00068 
0.00036 
0.00082 
-0.00128 
0.00049 
-0.00093 
0.00095 
0.00031 
- 0.00012 
-0.00142 
0.00049 
0.00044 
0.00088 
0.00074 
-0.00152 
0.00033 
-0. 00065 
0.00073 
-0 .00223 
0.00256 
0 .00003 
- 0.00012 
-0.00135 
0 .00058 
0.00014 
0.00051 
-0 .00063 
0. 00141 
-0.00178 
0.00059 
0.00044 
-0.00071 
-0.00139 
0.00233 
-0.00023 
-0.00081 
-0.00089 
0. 00090 
0.00075 
-0.00127 
0.00133 



-118. 50040 
-118. 50020 
-118.49998 
-118.50024 
-118. 50011 
-118. 50192 
-118.49911 
-118. 50165 
-118.50328 
-118.49971 
-118.49936 
-118.49799 
-118. 50029 
-118.50047 
-118.49911 
-118. 50140 
-118. 50003 
-118. 49805 
-118. 50008 
-118.49973 
-118. 50121 
-118. 50075 
-118. 50034 
-118. 49910 
-118. 50046 
-118.49998 
-118, 50125 
-118.50031 
-118. 49976 
-118.49968 
-118.50154 
-118. 50137 
-118. 50098 
-118.49971 
-118. 49825 
-118.49969 
-118. 49934 
-118. 50020 
-118.49940 
-118. 50243 
-118.49973 
-118.49927 
-118.49907 
-118.50072 
-118. 50031 
-118, 50018 
-118.49947 
-118. 50011 
-118. 49820 
-118.50012 
-118. 49962 
-118.49901 
-118. 49980 
-118.50192 
-118. 49940 
-118. 49931 
-118. 50020 
-118.50162 
-118. 50089 
-118.49986 
-118. 50134 
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J 

0 

2 

3 

A 

5 

6 

7 

8 

9 

10 

11 

12 

13 

14 

15 

16 

17 

18 

19 

20 

21 

22 

23 

24 

25 

26 

27 

28 

29 

30 

31 

0 

2 

3 

4 

5 

6 

7 

8 

9 

10 

11 

12 

13 

14 

15 

16 

17 

18 

19 

20 

21 

22 

23 

24 

25 

26 

27 

28 

29 

30 



KALMAN FILTER PARAMETERS FOR ANGLE FILTER 



K 


PI 1(K) 


P12( K) 


Gl(K) 


1 


10000.0000 


0.0 


0.9999 


3 


1440001 .0000 


120000.0000 


1.0000 


5 


6.8125 


0.3202 


0.8720 


7 


2.7990 


0.1196 


0.7368 


9 


1.9142 


0.0666 


0.6569 


11 


1.4289 


0.0415 


0.5883 


13 


1.1400 


0. 0289 


0.5327 


15 


0.9634 


0.0224 


0.4907 


17 


0.8548 


0.0189 


0.4608 


19 


0.7893 


0.0172 


0.4411 


21 


0.7517 


0.0163 


0.4291 


23 


0.7317 


0.0159 


0. 4225 


25 


0.7221 


0.0158 


0.4193 


27 


0.7181 


0.0157 


0.4179 


29 


0.7167 


0.0157 


0.4175 


31 


0.7164 


0.0157 


0 .4174 


33 


0.7163 


0.0157 


0.4174 


35 


0.7162 


0.0157 


0.4173 


37 


0.7161 


0.0157 


0.4173 


39 


0.7160 


0. 0157 


0.4172 


41 


0.7159 


0.0157 


0.4172 


43 


0.7158 


0.0157 


0.4172 


45 


0.7157 


0. 0157 


0.4172 


47 


0.7157 


0.0157 


0.4172 


49 


0.7157 


0.0157 


0.41 71 


51 


0.7157 


0.0157 


0.4171 


53 


0.7157 


0.0157 


0.4171 


55 


0.7157 


0.0157 


0.4171 


57 


0.7157 - 


0.0157 


0.4171 


59 


0.7157 


0. 0157 


0.4171 


61 


0.7157 


0. 0157 


0.4171 


2 


10000.0000 


0 .0 


0.9999 


4 


1440001.0000 


120000.0000 


1.0000 


6 


6.8125 


0,3202 


0.8720 


8 


2.7990 


0.1196 


0.7368 


10 


1.9142 


0.0666 


0. 6569 


12 


1 .4289 


0.0415 


0.5883 


14 


1.1400 


0.0289 


0.5327 


16 


0.9634 


0.0224 


0.4907 


18 


0.8548 


0.0189 


0.4608 


20 


0.7893 


0. 0172 


0.4411 


22 


0.7517 


0.0163 


0.4291 


24 


0.7317 


0.0159 


0 .4225 


26 


0.7221 


0. 0158 


0.4193 


28 


0 .7181 


0.0157 


0.4179 


30 


0.7167 


0.0157 


0.4175 


32 


0.7164 


0. 0157 


0.4174 


34 


0.7163 


0.0157 


0.4174 


36 


0.7162 


0.0157 


0.4173 


38 


0.7161 


0.0157 


0.4173 


40 


0.7160 


0.0157 


0.4172 


42 


0.7159 


0.0157 


0.4172 


44 


0 .7158 


0.0157 


0.4172 


46 


0.7157 


0.0157 


0.4172 


48 


0.7157 


0. 0157 


0.4172 


50 


0.7157 


0.0157 


0.4171 


52 


0.7157 


0. 0157 


0.4171 


54 


0.7157 


0.0157 


0.4171 


56 


0.7157 


0.0157 


0.4171 


58 


0.7157 


0. 0157 


0.4171 


60 


0 .7157 


0.0157 


0.4171 



G2(K) 

0.0 

0.0833 
0.0410 
0.0315 
0.0229 
0.0171 
0.0135 
0.0114 
0.0102 
0. 0096 
0 .0093 
0.0092 
0.0092 
0 .0092 
0. 0092 
0.0092 
0.0092 
0. 0092 
0.0092 
0.0092 
0.0092 
0 .0092 
0.0092 
0.0092 
0.0092 
0.0092 
0.0092 
0.0092 
0.0092 
0.0092 
0.0092 
0.0 

0.0833 
0.0410 
0.0315 
0.0229 
0.0171 
0 .0135 
0.0114 
0.0102 
0.0096 
0.0093 
0 .0092 
0.0092 
0.0092 
0 .0092 
0.0092 
0.0092 
0.0092 
0. 0092 
0.0092 
0.0092 
0. 0092 
0 .0092 
0.0092 
0.0092 
0.0092 
0.0092 
0.0092 
0.0092 
0.0092 
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J 

0 

2 

3 

4 

5 

6 

7 

8 

9 

10 

11 

12 

13 

14 

15 

16 

17 

18 

19 

20 

21 

22 

23 

24 

25 

26 

27 

28 

29 

30 

31 

0 

2 

3 

4 

5 

6 

7 

8 

9 

10 

11 

12 

13 

14 

15 

16 

17 

18 

19 

20 

21 

22 

23 

24 

25 

26 

27 

28 

29 

30 



KALMAN FILTER PARAMETERS FOR ANGLE FILTER 



K 


T ( K ) 


THTD ( K ) 


TDTD(K ) 


E ( K ) 


GATE ( K ) 


1 


0.0 


106. 6854 


0. 0930 






3 


12.000 


104. 1513 


- 0.2112 


- 3.6504 


3600.0022 


5 


12.000 


102. 3046 


- 0.1789 


0.7882 


8.3853 


7 


12.000 


100. 2979 


- 0. 1729 


0.1896 


5.8473 


9 


12.000 


98.7523 


- 0.1545 


0.8055 


5.1213 


11 


12.000 


96.2384 


- 0.1736 


- 1.1222 


4.6754 


13 


12.000 


93.7121 


- 0.1849 


- 0.8310 


4.3886 


15 


12.000 


92. 1992 


- 0.1685 


1.4376 


4.2036 


17 


12.000 


88.9479 


- 0.1957 


- 2.6682 


4. 0857 


19 


12.000 


87.1063 


- 0. 1847 


1.1494 


4.0130 


21 


12.000 


85.4691 


- 0. 1721 


1.3497 


3.9706 


23 


12 .000 


83.4872 


- 0.1703 


0.1983 


3.9478 


25 


12. 000 


81.0928 


- 0. 1780 


- 0.8360 


3 .9368 


27 


12.000 


78.6840 


- 0. 1840 


- 0.6535 


^ 3.9322 


29 


12.000 


76.7533 


- 0.1779 


0.6632 


3.9307 


31 


12.000 


74 . 8173 


- 0.1735 


0.4758 


3.9303 


33 


12.000 


73.1776 


- 0. 1638 


1.0604 


3.9302 


35 


12.000 


71.3944 


- 0.1598 


0.4371 


3.9301 


37 


1 2 . 00 0 


68.8458 


- 0.1737 


- 1. 5126 


3.9300 


39 


12.000 


66.4753 


- 0.1799 


- 0. 6871 


3.9299 


41 


12.000 


64.3785 


- 0.1786 


0.1502 


3.9297 


43 


12.000 


62.9310 


- 0. 1633 


1 . 6668 


3.9296 


45 


12.000 


62.0470 


- 0.1397 


2.5784 


3.9296 


47 


12.000 


60.6745 


- 0 . 1330 


0.7282 


3.9296 


49 


12.000 


59.0022 


- 0. 1347 


- 0. 1829 


3. 9295 


51 


12.000 


56.8325 


- 0.1468 


- 1 .3267 


3.9295 


53 


12.000 


55. 2973 


- 0. 1419 


0 . 5438 


3.9295 


55 


12.000 


53.6019 


- 0.1417 


0.0165 


3.9295 


57 


12.000 


52.4651 


- 0.1293 


1.3513 


3 .9295 


59 


12.000 


51.7908 


- 0.1101 


2 . 1038 


3.9295 


61 


12.000 


50.6026 


- 0. 1071 


0.3174 


3.9295 


2 


0 . 0 


123 . 1348 


0. 0810 






4 


12.000 


122.4821 


- 0.0544 


- 1.6245 


3600.0022 


6 


12.000 


120.9605 


- 0.0952 


- 0.9966 


8.3853 


8 


12 . 0C0 


118.2154 


- 0. 1637 


- 2.1748 


5.8473 


10 


12 .000 


116.7974 


- 0. 1447 


0. 8319 


5. 1213 


12 


12.000 


115. 7090 


- 0.1259 


1. 1009 


4.6754 


14 


12.000 


114.5483 


- 0. 1170 


0 . 6568 


4.3886 


16 


12 .000 


113.1856 


- 0.1160 


0.0843 


4.2036 


18 


12.000 


111. 6861 


- 0.1184 


- 0.2320 


4.0857 


20 


12.000 


109.9158 


- 0. 1260 


- 0.7919 


4.0130 


22 


12.000 


1 08.6817 


- 0.1200 


0.6479 


3.9706 


24 


12.000 


107.5498 


- 0.1133 


0. 7287 


3.9478 


26 


12 .000 


105.9513 


- 0.1185 


- 0.5700 


3. 9368 


28 


12i000 


104.4048 


- 0. 1212 


- 0.2975 


3.9322 


30 


12.000 


102.5540 


- 0.1299 


- 0 . 9485 


3.9307 


32 


12.000 


100.6689 


- 0.1371 


- 0.7811 


3.9303 


34 


12.000 


99. 1687 


- 0.1339 


0.3474 


3 .9302 


36 


12.000 


97.4578 


- 0. 1362 


- 0.2492 


3.9301 


38 


12.000 


95.2066 


- 0.1497 


- 1.4783 


3.9300 


40 


12. 000 


93.8084 


- 0. 1410 


0.9555 


3.9299 


42 


12.000 


92.4781 


- 0.1330 


0.8666 


3.9297 


44 


12.000 


90.7845 


- 0. 1352 


- 0.2328 


3 .9296 


46 


12.000 


89.0024 


- 0. 1387 


- 0. 3833 


3.9296 


48 


12.030 


87.9807 


- 0.1246 


1.5404 


3.9296 


50 


12.000 


85.7274 


- 0. 1412 


- 1.8180 


3 .9295 


52 


12 .000 


82.8544 


- 0. 1671 


- 2.8246 


3.9295 


54 


12.000 


8 0 . 5045 


- 0. 1747 


- 0.8260 


3 .9295 


56 


12.000 


79.5839 


- 0. 1489 


- 2r8182 


3.9295 


58 


12.000 


77.7355 


- 0.1502 


- 0.1490 


3.9295 


60 


12.000 


75.9437 


- 0 . 1500 


0.0261 


3.9295 
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TARGET NUMBER 1 



filtered and smoothed emitter data correlated to target number 1 



K 


FREO 


PRF 


PW 


THETAD 


THTD 


SLAD 


SLOD 


1 


1197.0 


150.0 


3.50 


106.6854 


106.6854 


33.4991 


-118. 5004 


3 


1197. 0 


150.0 


3.50 


104.1513 


104.1513 


33.4670 


-118.5002 


5 


1197.0 


150.0 


3.50 


102.4055 


102.3046 


33.4326 


-118.5007 


7 


1197.0 


150.0 


3 .50 


100.3478 


100.2979 


33.4000 


-118. 5012 


9 


1197.0 


150.0 


3.50 


99.0287 


98.7523 


33.3669 


-118.5006 


11 


1197.0 


150.0 


3.50 


95.7764 


96.2384 


33.3334 


-118. 4993 


13 


1197.0 


150 .0 


3.50 


93.3238 


93.7121 


33.3003 


-118.4999 


15 


1197.0 


150.0 


3.50 


92.9314 


92.1992 


33.2663 


-118.5003 


17 


1197.0 


150 .0 


3.50 


87.5094 


88.9479 


33.2329 


-118.4994 


19 


1197.0 


150.0 


3.50 


87.7487 


87 . 1063 


33.2001 


-118.4999 


21 


1197.0 


150.0 


3.50 


86. 2396 


85.4691 


33.1664 


-118.5005 


23 


1197.0 


150.0 


3.50 


33.6013 


83.4872 


33. 1337 


-118.4999 


25 


1197. 0 


150.0 


3.50 


80.6074 


81.0928 


33 . 1003 


-118. 5002 


27 


1197.0 


150.0 


3.50 


78.3036 


78.6840 


33.0670 


-118.5003 


29 


1197.0 


150.0 


3.50 


77.1396 


76.7533 


33.0337 


-118. 5002 


31 


1197. 0 


150.0 


3.50 


75.0945 


74.8173 


33.0003 


-118.5010 


33 


1197.0 


150 .0 


3. 50 


73.7954 


73. 1776 


32. 9669 


-118.5000 


35 


1197.0 


150.0 


3.50 


71.6491 


71.3944 


32.9339 


-118.4995 


37 


1197.0 


150.0 


3.50 


67.9644 


68.8458 


32.8998 


-118 .4998 


39 


1197.0 


150.0 


3. 50 


66.0749 


66.4753 


32.8670 


-118. 5007 


41 


1197.0 


150.0 


3.50 


64.4660 


64.3785 


32.8340 


-118.4997 


43 


1197.0 


150.0 


3.50 


63.9025 


62.9310 


32.8003 


-118.5001 


45 


1197.0 


150 .0 


3.50 


63.5497 


62.0470 


32.7663 


-118. 5001 


47 


1197. 0 


150.0 


3.50 


61.0990 


60.6745 


32.7334 


-118.4997 


49 


1197.0 


150.0 


3.50 


58.8956 


59.0022 


32. 6994 


-118.4995 


51 


1197.0 


150 .0 


3.50 


56.0593 


56.8325 


32.6665 


-118.4995 


53 


1197. 0 


150.0 


3.50 


55.6143 


55.2973 


32.6332 


-118.5004 


55 


1197.0 


150.0 


3. 50 


53.6115 


53.6019 


32.5998 


-118. 4998 


57 


1197. 0 


150.0 


3.50 


53.2528 


52 .4651 


32.5663 


-118.5007 


59 


1197.0 


150.0 


3.50 


53.0171 


51.7908 


32.5334 


-118.5005 


61 


1197.0 


150.0 


3.50 


50.7876 


50.6026 


32.5010 


-118.5002 


SMOOTHED 


INITIAL BEARING ANGLE 


= 106.68590 N 





FILTERED FINAL BEARING ANGLE = 50.60260 W 



- VECTOR METHOD SOLUTION 
EMITTER LATITUDE 
EMITTER LONGITUDE 



OF EMITTER LOCATION 
= 33.22765 N 

=-117.43607 W 
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1 






m 






TARGET NUMBER 2 



filtered and smoothed emitter data correlated to target number 2 



K 


FREO 


PRF 


P/i 


thetad 


thtd 


SLAD 


SLOD 


2 


1212.0 


250. 0 


3.00 


123. 1348 


123.1348 


33 .4856 


-118.5002 


4 


1212.0 


250.0 


3.00 


122.4821 


122.4821 


33.4498 


-118.5004 


6 


1212.0 


250.0 


3.00 


120.8329 


120.9605 


33.4160 


-118.5004 


8 


1212.0 


250.0 


3.00 


1 17. 6429 


118.2154 


33.3836 


-118 .5015 


10 


1212.0 


250.0 


3.00 


117.0829 


116.7974 


33.3499 


-118.4998 


12 


1212.0 


250.0 


3.00 


116.1623 


115.7090 


33.3168 


-118.4997 


14 


1212.0 


250.0 


3.00 


114.8552 


114.5483 


33.2832 


-118.4999 


16 


1212.0 


250.0 


3 .00 


113.2285 


113. 1856 


33.2496 


-118. 4999 


18 


1212.0 


250. 0 


3.00 


111.5610 


111.6861 


33.2163 


-118.4996 


20 


1212.0 


250.0 


3.00 


109.4732 


109.9158 


33.1830 


-118.5004 


22 


1212.0 


250.0 


3 .00 


109.0516 


108.6817 


33.1502 


-118.5002 


24 


1212.0 


250.0 


3.00 


107.9706 


107.5498 


33.1168 


-118.5001 


26 


1212.0 


250 .0 


3.00 


105.6203 


105.9513 


33.0837 


-118. 5005 


28 


1212. 0 


250.0 


3.00 


104.2317 


104.4048 


33.0503 


-118.5001 


30 


1212.0 


250. 0 


3.00 


102.0015 


102.5540 


33.0171 


-118.5008 


32 


1212.0 


250.0 


3.00 


100.2138 


100.6689 


32.9836 


-118.5007 


34 


1212. 0 


250.0 


3.00 


99.3712 


99.1687 


32.9505 


-118.4994 


36 


1212.0 


250.0 


3.00 


97.3126 


97.4578 


32.9167 


-118.4995 


38 


1212.0 


250 .0 


3.00 


94.3452 


95.2066 


32.8835 


-118.5000 


40 


1212.0 


250.0 


3.00 


94. 3653 


93.8084 


32.8505 


-118 .5002 


42 


1212.0 


250.0 


3.00 


92.9832 


92.4781 


32.8174 


-118.4997 


44 


1212.0 


250.0 


3.00 


90.6488 


90.7845 


32.7829 


-118.5002 


46 


1212.0 


250. 0 


3. 00 


88.7791 


89.0024 


32. 7499 


-118.4998 


48 


1212.0 


250.0 


3.00 


88.8786 


87.9807 


32.7166 


-118.4993 


50 


1212. 0 


250.0 


3. 00 


84.6678 


85.7274 


32.6828 


-118.4995 


52 


1212.0 


250.0 


3.00 


81.2080 


82,8544 


32.6499 


-118.4999 


54 


1212.0 


250.0 


3.00 


80.0231 


80.5045 


32.6162 


-118. 5000 


56 


1212.0 


250. 0 


3.00 


81.2266 


79.5839 


32.5830 


-118 .5002 


58 


1212.0 


250.0 


3.00 


77.6486 


77.7355 


32. 5498 


-118.5007 


60 


1212.0 


250.0 


3.00 


75.9589 


75 .9437 


32.5172 


-118.5006 


SMOOTHED 


INITIAL BEARING ANGLE 


= 123.13492 N 






FILTERED FINAL BEARING ANGLE 


= 75.94370 W 





VECTOR method SOLUTION OF EMITTER LOCATION 
EMITTER LATITUDE = 32.77921 N 

EMITTER LONGITUDE =-117.22505 W 



:3t* fr. j: It 4^* ft ifr. fti}::}.* a!?**!? 
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PLOT OF ERROR COURRIRNCES OF SMOOTHED BEHRING LINES 




Figure 12. a. Angle Filter Error Ellipse Associated with 
Lines-of-Bearing on Emitter 1. 

U' 75 SjTsO 33 ' 25 33 ' 00 32'. 75 

DEGREES LRTITUDE 
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-lie: 75 -118.50 -118.25 -118.00 -117.75 -117.50 -117.25 -117.. 00 
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DEGREFS LONGITUDE 



PLOT OF FRRQR CaURRIRNCEb OF SMaaiHED BERRING LINES 




DEGREES LRTITUDE 



86 
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DEGREES LONGITUDE 
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DET3REE5 LRTITUDE 
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- 118 - - 112-50 - 118-25 - 118-00 - 117- ?5 - 117-50 - 117-25 - 117-00 

DEGREES LONGITUDE 



PLOT OF FRR3R COURRIRNCES OF SHOOTHEQ BERRING LINES 
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- 118^75 - 118.50 - 118.25 - 118. 00 - 117.75 - 117.50 - 117.25 - 117.00 

DEGREES LONGITUDE 



Plot a.F ERROR CQURRIRRCES OF ShaaTHED BERR[!sG lIHES 
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DEGREES longitude 



PLOT 3F KRRGR COURRIRNCES OF SMOOTHED RERRING lINES 
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-11.3. E5 -118.00 -117.75 -117.50 -117.75 -117.00 
DEGREES LONGITUDE 



PLOT OF FRROR COURHIRNCE3 OF 3H00THFD BERRIHG LINES 
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DEGREE-:S LONGITUDE 



PLOT QF FRROR COWlRJflHCES tlF SMaQTHFD BERRING L1NF3 
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DEGREES L0MGITUDE 



PLOT ar tIRROR CQURRJnNCES OF SMaOTHED BERfUHG LINES 
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-user’s -118-50 -118-25 -118-00 -112-25 -112-50 -112.25 -112-00 

DEGREES LCNGITUDE 



PLOT OF FRR3R CGi^RRlRNCES OF 3H00THEC BERRING LINES 




94 



DEGREES LONGITUDE 



PLOT OF FRRaR CQUnRiHHCES QF SMOaTHFD 3ERR1NG LINES 




95 



PLOT OF FRRQR COURRIRHCES GF 3MDQTHEC BL'RRIHG UHE3 




96 



-1.18-75 -118-50 -118- Z5 -118-00 -117-75 -117-50 -117- Z5 -117- 

DEGREES LQNGITUDE 



PLOT OF ERROR COURRIRHCES OF SMOaTHED 3ERH1HG LINES 
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PLOT OF HRROR COURRlRHCtS OF SMOOTHED SERRIHG LINES 
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DEGREES LDINGITUDE 



PLOT OF E'RROR COURRIRNCES OF SMOOTHED BERRING LINES 







3S: 2? 33. 02 

DEGREES LRTITUDE 



33.52 



32 .?? 



CO 



DEGREES LONGITUDE 



PLCT OF ERROR COURHERROES OF SMOOTHED BERRJHG LINES 
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DEGREES LONGITUDE 



PLOT OF [-RROR COURRJRNCES OF SMOOTHED BERRING EINES 
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degre;e-:s longitude 



PLflT OF E:RR0R COURHlRHCtS GF SKIOOTHED BEflHlHG LJHE5 




102 



DEGREES LONGITUDE 



PLOT OF ERROR COUnRlRh'CES OF SMOOTHED BERRING LINES 




103 



- 118-75 - 113-50 - 118-25 - 118-00 - 117-75 - 117-50 - 117-25 - 117.00 

DEGREES LONGITUDE 



PL3T OF F.RROR COURRIRHCES OF SMOOTHED BERHIHG LINES 




104 



DEGREES LGHGITUDE 



PLOT OF ERROR C0URRIRNCE3 OF SMOOTHED BEHRING LINES 




105 



DEGREES LONGITUDE 




HUM. -wv’ 



PLOT Of-' EIRROR COURRlRHCtS OR SMOOTHED BERHIHG LINES 
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-118-75 -118.50 -118. Z5 -118.00 -117.75 -117.50 -117. Z5 -117.00 

DEGREES LOriGITUDE 



PLOT OF FRROR CQURRIRNCES OF SMOOTHED BEHRING LINES 
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DEGREES LONGITUDE 



PL3T OF ERROR GOURRIRHCES OF SMOOTHED BERRIHG LINES 




DEGREES LONGITUDE 



PLOT or E'.RROR C0URR.1RNCL5 OF 5KQQTHED BERRING LINES 
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-11S.75 -118.50 -118.25 -118.00 -117.75 -117.50 -117.25 -117.00 

DEGREES LONGITUDE 



K 

1 

2 

3 

4 

5 

6 

7 

8 

9 

10 

1 1 

12 

13 

14 

15 

16 

17 

18 

19 

20 

21 

22 

23 

24 

25 

26 

27 

28 

29 

30 

31 

32 

33 

34 

35 

36 

37 

38 

39 

40 

41 

42 

43 

44 

45 

46 

47 

48 

49 

50 

51 

52 

53 

54 

55 

56 

57 

58 

59 

60 

61 



NAVIGATION DATA FILTER PARAMETERS 



SGI 


SG2 


SPll 


SP12 


SP22 


T 


0.0 


0.0 


1.00000 


0.0 


1.00000 


0.0 


0.99999 


0 . 16216 


37.00000 


6.00000 


1.00004 


6 . 00 


0.99957 


0.16646 


0.97585 


0.16251 


0.02711 


6.00 


0. 89002 


0. 11174 


0.00337 


0.00042 


0. 00009 


6.00 


0.86395 


0.10864 


0.00265 


0.00033 


0. 00008 


6.00 


0.86253 


0.10906 


0.00261 


0.00033 


0.00008 


6.00 


0.86251 


0. 10903 


0.00261 


0. 00033 


0.00008 


6.00 


0.86246 


0 . 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0 . 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0. 10901 


0.00261 


0.00033 


0.00008 


6 . 00 


0. 86246 


0.10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0 . 10901 


0.00261 


0.00033 


0. 00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6 . 00 


0. 86246 


0 . 10901 


0.00261 


0.00033 


0. 00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6 . 00 


0.86246 


0. 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0 . 1090 1 


0.00261 


0.00033 


0. 00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0. 00008 


6.00 


0.86246 


0. 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0 . 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0. 10901 


0.00261 


0.00033 


0.00003 


6.00 


0. 86246 


0 . 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6 . 00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6.00 


0. 86246 


0.10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0 . 10901 


0 . 00261 


0.00033 


0.00008 


6.00 


0.86246 


0. 10901 


0.00261 


0.00033 


0.00003 


6.00 


0. 86246 


0 . 10901 


0.00261 


0 .00033 


0.00008 


6.00 


0. 86246 


0 . 10901 


0. 00261 


0.00033 


0.00008 


6.00 


0.86246 


0. 10901 


0.00261 


0.00033 


0.00008 


6 . 00 


0 . 86246 


0.10901 


0.00261 


0.00033 


0.00008 


6.00 


0. 86246 


0 . 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6.00 


0. 86246 


0 . 10901 


0. 00261 


0.00033 


0.00008 


6.00 


0.86246 


0 . 10901 


0.00261 


0.00033 


0.00008 


6.00 


0. 86246 


0 . 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0. 10901 


0.00261 


0.00033 


0. 00008 


6.00 


0.86246 


0 . 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0. 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0. 10901 


0.00261 


0.00033 


0.00008 


6 . 00 


0. 86246 


0. 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0. 10901 


0.00261 


0.00033 


0. 00008 


6 . 00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6 . 00 


0. 86246 


0. 10901 


0.00261 


0.00033 


0.00003 


6.00 


0.86246 


0. 10901 


0.00261 


0. 00033 


0. 00008 


6 . 00 


0.86246 


0. 1090 1 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0. 10901 


0. 00261 


0.00033 


0.00008 


6.00 


0.86246 


0. 10901 


0.00261 


0.00033 


0.00008 


6 . 00 


0 . 86246 


0. 10901 


0.00261 


0 .00033 


0.00008 


6.00 


0.86246 


0 . 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6 . 00 


0.86246 


0 . 10901 


0.00261 


0.00033 


0.00008 


6.00 


0.86246 


0 . 10901 


0.00261 


0.00033 


0. 00008 


6.00 


0.86246 


0.10901 


0.00261 


0.00033 


0.00008 


6.00 


0 . 86246 


0 . 10901 


0. 00261 


0.00033 


0.00008 


6.00 


0.86246 


0 . 10901 


0.00261 


0.00033 


0.00008 


6 . 00 


0 . 8 6 246 


0 . 10901 


0.00261 


0.00033 


0.00008 


6.00 


0. 86246 


0 . 10901 


0.00261 


0.00033 


0. 00008 


6.00 


0.86246 


0. 10901 


0.00261 


0.00033 


0.00008 


6 . 00 


0.86246 


0. 10901 


0.00261 


0.00033 


0.00008 


6.00 
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NAVIGATION DATA FILTER PARAMETERS 



K VELND ELAT 



SLATD VELED ELON 



SLOND 



1 - 0.00225 

2 - 0.00225 

3 - 0.00316 

4 - 0.00290 

5 - 0.00282 

6 - 0.00288 

7 - 0.00273 

8 - 0.00256 

9 - 0.00284 

10 - 0.00279 

11 - 0.00284 

12 - 0.00270 

13 - 0.00279 

14 - 0.00273 

15 - 0.00291 

16 - 0.00278 

17 - 0.00275 

18 - 0.00278 

19 - 0.00281 

20 - 0.00256 

21 - 0.00298 

22 - 0.00276 

23 - 0.00260 

24 - 0.00277 

25 - 0.00294 

26 - 0.00262 

27 - 0.00280 

28 - 0.00278 

29 - 0.00280 

30 - 0.00274 

31 - 0.00275 

32 - 0.00282 

33 - 0.00279 

34 - 0.00277 

35 - 0.00274 

36 - 0.00272 

37 - 0.00295 

38 - 0 . 00280 

39 - 0.00260 

40 - 0.00280 

41 - 0.00277 

42 - 0.00274 

43 - 0.00277 

44 - 0.00285 

45 - 0.00299 

46 - 0.00265 

47 - 0.00270 

48 - 0.00282 

49 - 0.00277 

50 - 0.00290 

51 - 0.00271 

52 - 0.00266 

53 - 0.00287 

54 - 0.00270 

55 - 0.00295 

56 - 0.00260 

57 - 0.00283 

58 - 0.00285 

59 - 0.00263 

60 - 0.00278 

61 - 0.00268 



0.0 

0.0 

- 0.00546 
0.00235 
0.00075 
- 0.00063 
0 .00140 
0.00162 
- 0.00266 
0.00052 
- 0.00050 
0.00134 
- 0.00089 
0. 00055 
- 0.00160 
0.00113 
0.00032 
- 0.00029 
- 0. 00031 
0 . 00233 
- 0.00383 
0. 00197 
0.00153 
- 0.00163 
- 0.00154 
0.00294 
- 0.00165 
0.00017 
- 0.00018 
0.00058 
- 0.00006 
- 0,00072 
0.00035 
0.00015 
0.00024 
0.00024 
- 0.00212 
0.00133 
0.00186 
- 0.00186 
0.00031 
0.00024 
- 0.00027 
- 0.00067 
-0 .00130 
0. 00305 
- 0.00040 
- 0.00116 
0.00047 
- 0.00119 
0.00172 
0. 00050 
- 0 .00189 
0. 00150 
- 0.00229 
0.00323 
- 0.00212 
- 0.00015 
0.00200 
- 0 . 0 C 134 
0.00092 



33.49908 
33.48558 
33.47208 
33.44765 
33.43234 
33.41608 
33.39821 
33.38303 
33. 36908 
33.34970 
33.33340 
33.31590 
33.30086 
33.28333 
33.26740 
33.24855 
33.23280 
33.21657 
33.19962 
33.18245 
33.16908 
33. 14790 
33. 13301 
33.11874 
33. 10068 
33.08167 
33.06847 
33.05022 
33.03365 
33.01665 
33.00069 
32.98415 
32.96657 
32.95013 
32.93364 
32.91737 
32.90126 
32.83174 
32.86606 
32.85205 
32. 83360 
32.81725 
32.80098 
32.78409 
32.76642 
32.74736 
32.73405 
32.71751 
32.69955 
32.68330 
32.66484 
32.65002 
32.63449 
32.61566 
32.60072 
32.58102 
32. 56819 
32.54936 
32.53214 
32.51805 
32.50023 



0. 00003 
0.00003 
- 0.00001 
0. 00000 
- 0.00012 
0. 00012 
- 0.00010 
- 0.00016 
0.00015 
0.00010 
0.00014 
- 0.00008 
- 0.00005 
0.00006 
- 0.00012 
0.00003 
0.00014 
- 0.00006 
- 0.00001 
- 0. 00010 
- 0.00002 
0.00001 
0.00009 
- 0.00004 
0.00001 
- 0.00008 
0.00002 
0.00004 
0.00003 
- 0.00011 
- 0. 00005 
0.00000 
0.00008 
0.00014 
- 0.00002 
0.00001 
- 0.00005 
0.00002 
- 0 . 00018 
0.00008 
0.00007 
0.00005 
- 0.00008 
- 0. 00002 
- 0.00000 
0.00005 
- 0.00002 
0.00011 
- 0.00007 
- 0.00000 
0.00004 
- 0.00003 
- 0.00016 
0. 00008 
0. 00005 
- 0.00003 
- 0.00011 
- 0.00001 
0.00006 
- 0.00007 
0.00007 



0.0 

0.00003 - 
- 0.00023 - 
0.00011 - 
- 0.00132 - 
0.00239 - 
- 0.00224 - 
- 0.00080 - 
0.00310 - 
- 0.00029 - 
0.00061 - 
- 0.00213 - 
0.00014 - 
0.00114 - 
- 0.00185 - 
0.00139 - 
0.00130 - 
- 0.00195 - 
0.00046 - 
- 0.00103 - 
0.00068 - 
0.00036 - 
0.00082 - 
- 0.00128 - 
0.00049 - 
- 0.00093 - 
0.00095 - 
0.00031 - 
- 0.00012 - 
- 0.00142 - 
0.00049 - 
0.00044 - 
0.00088 - 
0.00074 - 
- 0.00152 - 
0.00033 - 
- 0.00065 - 
0.00073 - 
- 0.00223 - 
0.00256 - 
0.00003 - 
- 0.00012 - 
- 0.00135 - 
0.00058 - 
0.00014 - 
0.00051 - 
- 0.00063 - 
0.00141 - 
- 0.00178 - 
0.00059 - 
0.00044 - 
- 0.00071 - 
- 0.00139 - 
0.00233 - 
- 0.00023 - 
- 0.00081 - 
- 0.00089 - 
0.00090 - 
0.00075 - 
- 0.00127 - 
0.00133 - 



118. 50040 

118.50020 
118.49998 
118. 50024 

118.50011 
118. 50192 
118. 49911 
118.50165 
118.50328 
118.49971 
118.49936 
118. 49799 
118.50029 
118. 50047 
118.49911 
118.50140 
118.50003 
118.49805 
118.50008 
118.49973 
118. 50121 
118.50075 
118. 50034 
118.49910 
118. 50046 
118. 49998 
118.50125 
118.50031 
118. 49976 

118.49968 
118. 50154 
118.50137 
118.50098 
118. 49971 
118. 49825 

118.49969 
118. 49934 

118.50020 
118. 49940 
118.50243 
118.49973 
118.49927 
118.49907 
118.50072 
118.50031 
118 .50018 
118.49947 

118.50011 
118.49820 

118. 50012 
118.49962 
118.49901 
118. 49980 
118 .50192 
118. 49940 
118.49931 

118. 50020 
118. 50162 
118.50089 
118. 49986 
118.50134 
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KALMAN FILTER PARAMETERS FOR ANGLE FILTER 



I 


J 


K 


PIKK) 


P12( K) 


GKK) 


G2(K) 


1 


0 


1 


10000.0000 


0.0 


0 ,9999 


0.0 


1 


2 


3 


1440001.0000 


120000. 0000 


1.0000 


0.0833 


1 


3 


5 


6.8125 


0.3202 


0.8720 


0.0410 


1 


4 


7 


2.7990 


0.1196 


0.7368 


0.0315 


2 


0 


2 


10000.0000 


0.0 


0.9999 


0.0 


2 


2 


4 


1440001 .0000 


120000.0000 


1.0000 


0.0833 


2 


3 


6 


6.8125 


0.3202 


0.8720 


0.0410 


2 


4 


8 


2.7990 


0. 1196 


0.7368 


0.0315 
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KALMAN FILTER PARAMETERS FOR ANGLE FILTER 



I J K T(K) 

101 0.0 

123 12.000 

135 12.000 

1 4 7 12.000 

2 0 2 0.0 

224 12.000 

236 12.000 

248 12.000 



THTD(K) TDTD(K) 

106.6854 0.0930 

104.1513 - 0.2112 

102.3046 - 0.1789 

100.2979 - 0.1729 

123.1348 0.0810 

122.4821 - 0.0544 

120.9605 - 0.0952 

118.2154 - 0.1637 



E(K) GATE(K) 

- 3.6504 3600.0022 

0.7882 8.3853 

0.1896 5.8473 

- 1.6245 3600.0022 

- 0.9966 8.3853 

- 2.1748 5.8473 
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THE EXTENDED KALMAN FILTER IS INITIATED WITH THE 
FOLLOWING ELLIPSE FOR CUT NUMBER 4 OF TARGET 1 



THE ANGLE BETWEEN THE MAJOR AXIS AND THE 
THROUGH THE CENTER OF THE ELLIPSE IS 104 

THE length of THE SEMI-MAJOR AXIS IS 0 

THE LENGTH OF THE SEMI-MINOR AXIS IS 0 



MERIDIAN 
941 DEGREES. 

255 DEGREES. 

019 DEGREES. 
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K 

7 

9 

11 

13 

15 

17 

19 

21 

23 

25 

27 

29 

31 

33 

35 

37 

39 

41 

43 

45 

47 

49 

51 

53 

55 

57 

59 

61 

K 

7 

9 

11 

13 

15 

17 

19 

21 

23 

25 

27 

29 

31 

33 

35 

37 

39 

41 

43 

45 

47 

49 

51 

53 

55 

57 

59 

61 



EXTENDED KALMAN FILTER PARAMETERS 



Pll 

0 .607E-01 
0.600E-01 
0.587E-01 
0.563E-01 
0.530E-01 
0.490E-01 
0.445F-01 
0.400F-01 
0 .355E-01 
0.315E-'01 
0.279E-01 
0.248E-01 
0.221F-01 
0.197E-01 
0.178E-01 
0.161E-01 
0.147E-01 
0.134E-01 
0.124E-01 
0.115E-01 
0.107E-01 
O.lOOE-01 
0.945E-02 
0.893E-02 
0.848E-02 
0.808E-02 
0.772E-02 
0.740E-02 



P12 

-0.16 lE-01 
-0.159E-01 
-0. 154E-01 
-0.147E-01 
-0.137E-01 
-0. 125E-01 
-0. 112E-01 
-0.984F-02 
-0.854E-02 
-0.736E-02 
-0.631E-02 
-0.541E-02 
-0.462E-02 
-0.396E-02 
-0.339E-02 
-0.291E-02 
-0.250E-02 
-0.215E-02 
-0.185E-02 
-0.159E-02 
-0. 136E-02 
-0.116E-02 
-0.991E-03 
-0.840E-03 
-0.706E-03 
-0.587E-03 
-0.480E-03 
-0.384E-03 



P22 


GX 


GY 


0.466E-02 


0.112 


-0.038 


0.463E-02 


0.162 


-0 .052 


0.452E-02 


0.213 


-0.066 


0.433E-02 


0.247 


-0.075 


0.407E-02 


0.271 


-0.081 


0.374E-02 


0.283 


-0. 084 


0.338E-02 


0.282 


-0.083 


0.303E-02 


0.278 


-0.081 


0.268E-02 


0.265 


-0.077 


0.237E-02 


0.250 


-0.073 


0.211E-02 


0.233 


-0.068 


0.188E-02 


0.217 


-0.063 


0. 169E-02 


0.201 


-0.058 


0. 153E-02 


0. 186 


-0.054 


0.141E-02 


0.172 


-0.050 


0. 130E-02 


0.159 


-0.046 


0. 122E-02 


0.147 


-0.042 


0.116E-02 


0.137 


-0.040 


0. lllE-02 


0. 128 


-0. 037 


0.107E-02 


0.119 


-0.034 


0. 104E-02 


0.112 


-0.032 


0. 102E-02 


0. 104 


-0.030 


O.lOOE-02 


0.098 


-0.029 


0.995E-03 


0.092 


-0.02 7 


0.992E-03 


0.087 


-0.026 


0,992F-03 


0.082 


-0.024 


0. 997E-03 


0.077 


-0.023 


0. lOOE-02 


0.073 


-0.022 



DMX 


DMY 


TX 


ER 


XTD 


-0. 1794 


-1.0314 


1.7552 


-0.0038 


-117.4961 


-0.1434 


-1.0706 


1.7169 


0.0115 


-117. 4918 


-0.1003 


-1.1082 


1 .6731 


-0.0015 


-117 .4896 


-0.0614 


-1.1383 


1.6329 


-0. 0041 


-117.4890 


-0.0214 


-1.1676 


1.5921 


0.0299 


-117.4888 


0.0184 


-1.1950 


1.5552 


-0.0279 


-117.4849 


0.0551 


-1.2111 


1.5116 


0.0199 


-117.4873 


0.0952 


-1.2323 


1.4762 


0.0289 


-117.4850 


0.1308 


-1.2440 


1 .4402 


0.0189 


-117.4816 


0. 1648 


-1.2498 


1.4021 


0.0047 


-117.4790 


0.1974 


-1.2532 


1.3639 


0.0028 


-117.4777 


0.2293 


-1. 2548 


1.3271 


0.0192 


-117.4768 


0.2591 


-1. 2524 


1.2935 


0.0172 


-117.4747 


0.2868 


-1.2474 


1.2585 


0.0295 


-117.4728 


0.3120 


-1.2394 


1 .2264 


0.0241 


-117 .4701 


0.3348 


-1.2271 


1.1930 


-0. 0068 


-117.4678 


0.3544 


-1.2130 


1 .1593 


-0.0061 


-117.4673 


0.3747 


-1 .1995 


1.1279 


-0.0027 


-117.4671 


0.39 28 


-1.1829 


1.0972 


0.0181 


-117.4668 


0.4092 


-1.1646 


1 .0686 


0.0406 


-117.4657 


0.4227 


-1.1455 


1.0422 


0.0241 


-117.4636 


0.4340 


-1.1243 


1.0137 


0.0142 


-117.4621 


0.4436 


-1.1032 


0.9872 


-0.0088 


-117 .4610 


0.4516 


-1.081 0 


0.9607 


0.0099 


-117.4609 


0.4596 


-1 .0589 


0.9365 


-0.0008 


-117.4602 


0.4651 


-1.0360 


0.9123 


0.0172 


-117 .4599 


0.4702 


-1.0137 


0.8903 


0.0351 


-117.4592 


0.4738 


-0,9917 


0.8696 


0.0168 


-117.4580 



YTD 

33.2432 
33. 2473 

33.2476 
33.2481 
33.2486 

33.2477 
33.2489 
33.2484 
33.2476 
33 .2469 
33.2466 
33.2464 
33.2457 
33.2451 
33.2442 

33.2433 
33.2431 
33 .2429 
33.2427 
33.2422 
33 .2413 
33.2407 
33.2401 
33.2399 
33.2395 
33.2393 
33.2389 
33.2383 
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I 


















I. 



K 

7 

9 

11 

13 

15 

17 

19 

21 

23 

25 

27 

29 

31 

33 

35 

37 

39 

41 

43 

45 

47 

49 

51 

53 

55 

57 

59 

61 

K 

7 

9 

11 

13 

15 

17 

19 

21 

23 

25 

27 

29 

31 

33 

35 

37 

39 

41 

43 

45 

47 

49 

51 

53 

55 

57 

59 

61 



EXTENDED KALMAN FILTER PARAMETERS 



EPll 

0.607E-01 
0.239E-01 
0.134E 00 
0.106E 00 
0.712E-01 
0.538E-01 
0.450E-01 
0 .406E-01 
0.387E-01 
0 .381E-01 
0 .381E-01 
0.383E-01 
0.384E-01 
0.385E-01 
0 .385E-01 
0.385E-01 
0 .385E-01 
0 .385E-01 
0.385E-01 
0.385E-01 
0.385E-01 
0.385E-01 
0 .385E-01 
0.385E-01 
0.385E-01 
0.385E-01 
0.385E-01 
0.385E-01 



EP12 

-0. 161E-01 
0.668E-02 
0.15 lE-01 
0.745E-02 
0.382E-02 
0.249E-02 
0. 198E-02 
0. 179E-02 
0. 173E-02 
0. 174E-02 
0. 176E-02 
0. 178E-02 
0. 178E-02 
0. 179E-02 
0. 179E-02 
0.179E-02 
0. 179E-02 
0. 179E-02 
0. 179E-02 
0. 179E-02 
0.179E-02 
0. 179E-02 
0. 179E-02 
0. 179E-02 
0. 179E-02 
0.179E-02 
0. 179E-02 
0. 179E-02 



EP22 


G1 


G2 


0 .466E-02 


0.548 


-0.145 


0. 236E-02 


0.323 


0.090 


0. 179E-02 


0.728 


0.082 


0.594E-03 


0.679 


0.048 


0.273E-03 


0.587 


0.031 


0 . 189E-03 


0.518 


0.024 


0. 165E-03 


0.474 


0.021 


0. 160E-03 


0.448 


0.020 


0. 161E-03 


0.437 


0.020 


0. 163E-03 


0.433 


0.020 


0. 165E-03 


0.433 


0.020 


0.166E-03 


0.434 


0.020 


0. 166E-03 


0.435 


0.020 


0. 166E-03 


0.435 


0.020 


0. 166E-03 


0.435 


0.020 


0. 166E-03 


0.435 


0.020 


0. 165E-03 


0.435 


0.020 


0 .165E-03 


0.435 


0.020 


0.165E-03 


0.435 


0.020 


0. 165E-03 


0.435 


0.020 


0.165E-03 


0.435 


0.020 


0. 165E-03 


0.435 


0 .020 


0. 165E-03 


0.435 


0.020 


0 . 165E-03 


0.435 


0.020 


0. 165E-03 


0.435 


0.020 


0. 165E-03 


0.435 


0.020 


0. 165E-03 


0.435 


0.020 


0.165E-03 


0.435 


0.020 



EX 


EY 


XTDOOT 


YTDDOT 


XTDl 


0.0 


0.0 


0.0010 


0.00 10 


-117.4965 


-0. 0054 


-0.0059 


0.0004 


0.0005 


-117.4899 


-0.0006 


-0.0034 


0.0003 


0.0002 


-117.4899 


-0.0019 


-0.0011 


0.0002 


0.0001 


-117.4900 


-0.0018 


-0.0005 


0.0001 


0.0001 


-117.4807 


0.0062 


-0.0032 


0 .0002 


0.0000 


-117.4928 


-0.0077 


0.0021 


0.0000 


0.0001 


-117.4816 


0 .0045 


-0.0022 


0.0001 


0.0000 


-117.4769 


0. 0062 


-0.0026 


0 .0002 


-0.0000 


-117 .4765 


0.0032 


-0.0014 


0.0002 


-0.0000 


-117.4778 


-0.0001 


-0.0002 


0 .0002 


-0.0000 


-117.4770 


-0.0004 


0. 0000 


0.0001 


-0.0000 


-117.4726 


0.0028 


-0.0010 


0.0002 


-0.0001 


-117.4712 


0.0021 


-0.0007 


0.0002 


-0.0001 


-117.4673 


0.0037 


-0.0012 


0.0002 


-0.0001 


-117.4659 


0.0024 


-0.0006 


0.0002 


-0.0001 


-117.4688 


-0.0020 


0.0009 


0.0001 


-0.0001 


-117.4682 


-0.0015 


0.0008 


0.0001 


-0.0001 


-117.4674 


-0.0008 


0.0005 


0 .0001 


-0.0001 


-117.4645 


0.0016 


-0.0003 


0.0001 


-0.0001 


-117.4608 


0.0036 


-0.0010 


0.0001 


-0.0001 


-117.4609 


0.0016 


-0.0003 


0.0001 


-0.0001 


-117.4606 


0. 0005 


0.0001 


0.0001 


-0.0001 


-117.4619 


-0.0013 


0.0008 


0.0001 


-0.0001 


-117.4599 


0.0004 


0.0002 


0.0001 


-0.0001 


-117 .4603 


-0.0004 


0. 0004 


0.0001 


-0.0001 


-117.4585 


0.0009 


-0.0001 


0.0001 


-0.0001 


-117.4565 


0. 0020 


-0.0004 


0.0001 


-0.0001 


-117.4568 



YTDl 

33.2434 
33.2467 
33.2477 
33.2484 
33.2462 
33.2500 
33.2472 
33.2461 
33.2461 
33.2465 
33.2464 
33.2452 
33.2447 

33.2435 
33 .2430 

33.2436 
33.2433 
33.2430 
33.2420 

33.2403 
33.2405 
33.2402 

33.2404 
33.2397 
33.2396 
33.2389 
33.2381 
33.2379 
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I 






THE EXTENDED KALMAN FILTER IS INITIATED WITH THE 
FOLLOWING ELLIPSE FOR CUT NUMBER 4 OF TARGET 2 



THE ANGLE BETWEEN THE MAJOR AXIS AND THE 
THROUGH THE CENTER OF THE ELLIPSE IS 122 



THE 


LENGTH 


OF 


THE 


SEMI-MAJOR 


AXIS 


IS 


THE 


LENGTH 


OF 


THE 


SEMI-MINOR 


AXIS 


IS 



MERIDIAN 
129 DEGREES. 

361 DEGREES. 

023 DEGREES. 
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EXTENDED KALMAN FILTER PARAMETERS 



Pll 

0.934E-01 
0.933E-01 
0 .932E-01 
0.925E-01 
0.906E-01 
0 .870E-01 
0.816E-01 
0.747E-01 
0.669E-01 
0.589E-01 
0 .513E-01 
0.445E-01 
0.386E-01 
0 .335E-01 
0.292E-01 
0.256F-01 
0.225E-01 
0.199F-01 
0.177E-01 
0.159E-01 
0. 143E-01 
0.130E-01 
0. 118E-01 
0.109E-01 
O.lOOE-01 
0.925E-02 
0.860E-02 



P 12 

-0.583E-01 
-0.583E-01 
-0.582E-01 
-0.5775-01 
-0.564E-01 
-0.540E-01 
-0. 504E-01 
-0.459E-01 
-0.408E-01 
-0.356E-01 
-0.307E-01 
-0.263E-01 
-0.225E-01 
-0. 193E-01 
-0. 165E-01 
-0. 142E-01 
-0.122E-01 
-0. 106E-01 
-0.921E-02 
-0.804E-02 
-0.705E-02 
-0.620E-02 
-0.548E-02 
-0.4865-02 
-0.432E-02 
-0.386F-02 
-0.344E-02 



P22 


GX 


GY 


0.371E-01 


-0.038 


0.015 


0.372E-01 


0.036 


-0.032 


0.371E-01 


0. 116 


-0.083 


0 .3685-01 


0.193 


-0.132 


0.360E-01 


0.263 


-0.176 


0 .344E-01 


0.317 


-0.209 


0.320E-01 


0.353 


-0.232 


0.291E-01 


0.370 


-0.242 


0.259E-01 


0.373 


-0.242 


0.225E-01 


0.360 


-0.233 


0. 194E-01 


0.340 


-0.219 


0. 166E-01 


0.318 


-0.204 


0. 142E-01 


0.294 


-0.189 


0. 121E-01 


0.272 


-0.174 


0.104E-01 


0.250 


-0.160 


0. 8945-02 


0.230 


-0. 146 


0.774E-02 


0.211 


-0.134 


0.6735-02 


0.195 


-0.124 


0. 5895-02 


0. 180 


-0.114 


0.5185-02 


0.166 


-0.105 


0.459E-02 


0.154 


-0.097 


0.410E-02 


0. 143 


-0.090 


0.368E-02 


0.132 


-0.083 


0.332E-02 


0. 124 


-0.078 


0.302E-02 


0.116 


-0.073 


0.2765-02 


0.109 


-0.068 


0.2545- 02 


0.102 


-0. 064 



DMX 


DMY 


TX 


ER 


XTD 


YTD 


-0.3977 


-0.6036 


2.0672 


-0.0139 


-117.4485 


32.9048 


-0.3825 


-0.6431 


2.0379 


0. 0056 


-117.4464 


32.9055 


-0.3630 


-0.6822 


2.0063 


0.0211 


-117.4460 


32.9052 


-0. 3428 


-0.7220 


1.9754 


0.0292 


-117 .4444 


32.9038 


-0.3208 


-0. 7603 


1.9448 


0. 0314 


-117.4413 


32.9012 


-0.2977 


-0.7959 


1 .9146 


0.0325 


-117.4371 


32.8977 


-0. 2727 


-0.8287 


1.8842 


0.0265 


-117.4321 


32.8935 


-0.2477 


-0 . 8-59 5 


1.8535 


0.0498 


-117. 4273 


32.8894 


-0.2212 


-0.8901 


1.8263 


0.0581 


-117.4191 


32.8825 


-0. 1952 


-0.9131 


1.7991 


0.0444 


-117.4091 


32 .8741 


-0.1699 


-0.9326 


1.7687 


0.0505 


- 117. 4005 


32.8667 


-0. 1441 


-0.9517 


1 .7412 


0.0391 


-117.3913 


32.8586 


-0.1187 


-0.9690 


1.7109 


0.0381 


-117. 3836 


32.8515 


-0.0936 


-0.9876 


1.6825 


0.0519 


-117.3765 


32.8446 


-0.0677 


-1.0046 


1.6555 


0.0429 


-117.3684 


32 .8369 


-0.0433 


-1.0175 


1.6265 


0.0201 


-117.3615 


32.8299 


-0. 0189 


-1.0307 


1.5953 


0.0517 


-117.3570 


32.8247 


0.0066 


-1.0461 


1.5705 


0.0524 


-117.3506 


32.8180 


0.0315 


-1 .057 1 


1 .5415 


0.0407 


-117.3445 


32.8115 


0. 0546 


-1.0664 


1.5126 


0.0369 


-117.3394 


32 .8058 


0.0732 


-1.0757 


1.4840 


0.0673 


-117.3350 


32.8005 


0.1018 


-1.0834 


1 .4587 


0.0190 


-117.3292 


32.7943 


0. 1227 


-1.0873 


1.4272 


-0.0098 


-117.3262 


32 .7901 


0.1456 


-1.0930 


1.3954 


0.0013 


-117.3250 


32.7873 


0. 1687 


-1.0984 


1 .3671 


0.0506 


-117.3237 


32.7845 


0. 1908 


-1.1013 


1.3425 


0.0127 


-117.3206 


32.7805 


0.2102 


-1.1013 


1.3124 


0.0133 


-117.3191 


32.7778 
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EXTENDED KALMAN FILTER PARAMETERS 



EPll 


EP 12 


EP22 


G1 


G2 


0.934E-01 


-0.583E-01 


0 .371E-01 


0.651 


-0.407 


0.272E 00 


0.602E-01 


0. 135E-01 


0.845 


0.187 


0.234E 00 


0.225E-01 


0.223E-02 


0.824 


0.079 


0.105E 00 


0.662E-02 


0 .477E-03 


0.677 


0.043 


0.665E-01 


0.330E-02 


0. 230E-03 


0.571 


0.028 


0 .505E-01 


0.224E-02 


0. 172E-03 


0.502 


0.022 


0.429E-01 


0. 185E-02 


0.159E-03 


0.462 


0.020 


0.394E-01 


0.173E-02 


0. 158E-03 


0.441 


0.019 


0.381E-01 


0.171E-02 


0.160E-03 


0.432 


0.019 


0.379E-01 


0. 174E-02 


0. 163E-03 


0.431 


0.02 0 


0.380E-01 


0.176E-02 


0. 165E-03 


0.432 


0.020 


0.383E-01 


0. 178E-02 


0 .166E-03 


0.434 


0.020 


0.384E-01 


0. 179E-02 


0. 166E-03 


0.435 


0.02 0 


0 .385E-01 


0. 179E-02 


0 . 166E-03 


0.435 


0.020 


0.386E-01 


0. 179E-02 


0.166 E-03 


0 .435 


0.020 


0 .385E-01 


0. 179E-02 


0. 166E-03 


0. 435 


0.020 


0.385E-01 


0.179E-02 


0.165E-03 


0.435 


0.020 


0.385E-01 


0. 179E-02 


0. 165E-03 


0.435 


0.020 


0 .385E-01 


0.179E-02 


0. 165F-03 


0.435 


0.020 


0.385E-01 


0. 178E-02 


0.165E-03 


0.435 


0.020 


0.385E-01 


0.179E-02 


0. 165E-03 


0.435 


0.020 


0.385E-01 


0. 179E-02 


0.165E-03 


0.435 


0.020 


0.385E-01 


0. 179E-02 


0. 165E-03 


0.435 


0.020 


0.385E-01 


0.179E-02 


0.165E-03 


0.435 


0.020 


0.385E-01 


0. 179E-02 


0. 165E-03 


0.435 


0.020 


0.385E-01 


0. 179E-02 


0. 165E-03 


0.435 


0.020 


0.385E-01 


0.179E-02 


0 . 165E-03 


0.435 


0.020 



EX 


EY 


XTDDOT 


YTDDOT 


XTDl 


YTDl 


0.0 


0.0 


0.0010 


0.0010 


-117.4480 


32.9046 


-0.0046 


-0.0062 


0 .0001 


-0.0002 


-117.4462 


32.9053 


-0. 00 04 


0.0008 


0.0001 


-0.0001 


-117.4436 


32.9034 


0.0017 


-0. 0012 


0.0001 


-0.0001 


-117.4388 


32.8999 


0.0041 


-0.0030 


0 .0002 


-0.0002 


-117.4331 


32.8957 


0. 0059 


-0.0041 


0.0003 


-0.0003 


-117.4268 


32 .8909 


0.0072 


-0.0049 


0 .0004 


-0.0004 


-117.4228 


32.8874 


0.0061 


-0.0036 


0.0004 


-0.0005 


-117.4089 


32.8773 


0.0135 


-0.0091 


0.0006 


-0.0007 


-117.3974 


32.8684 


0.0154 


-0.0101 


0 .0007 


-0.0009 


-117.3931 


32.8638 


0.0098 


-0.0051 


0.0008 


-0.0010 


-117 .3834 


32.8556 


0.0105 


-0.0053 


0.0008 


-0.0011 


-117.3789 


32.8506 


0.0063. 


-0.0015 


0.0008 


-0.0011 


-117.3724 


32 . 8443 


0.0054 


-0. 0006 


0.0008 


-0.0011 


-117.3624 


32 .8356 


0.0080 


-0.0023 


0.0008 


-0.0012 


-117.3577 


32.8300 


0-0051 


0.0001 


0.0007 


-0.0012 


-117 .3569 


32.8270 


0.0002 


0.0040 


0.0006 


-0.0011 


-117.3461 


32.8177 


0-0060 


-0.0005 


0 .0006 


-0.0011 


-117.34C4 


32.8115 


0.0054 


0. 0001 


0.0006 


-0.0011 


-117.3372 


32.8068 


0.0030 


0.0019 


0.0006 


-0.0011 


-117.3333 


32.8019 


0.0023 


0.0024 


0 .0005 


-0.0010 


-117.3247 


32.7940 


0. 0061 


-0.0005 


0.0005 


-0.0010 


-117.3265 


32 .7926 


-0.0004 


0.0044 


0.0004 


-0.0009 


-117.3275 


32.7909 


-0.0033 


0.0064 


0.0003 


-0.0008 


-117 .3248 


32.7872 


-0.0015 


0. 0047 


0.0002 


-0.0007 


-117.3178 


32.7809 


0.0037 


0.0005 


0.0003 


-0.0007 


-117.3192 


32.7797 


-0. 0002 


0.0033 


0.0002 


-0.0006 


-117.3177 


32.7770 
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TARGET NUMBER 1 



FILTERED AND SMOOTHED EMITTER DATA CORRELATED TO TARGET NUMBER 1 



K FREO PRF 

1 1197.0 150.0 
3 1197.0 150.0 
5 1197.0 150.0 
7 1197.0 150.0, 



PW THETAD 

3.50 106.6854 

3.50 104.1513 

3.50 102.4055 

3.50 100.3478 



THTD 

106.6854 
104. 1513 
102.3046 
100.2979 



SLAD SLOD 

33.4991 -118.5004 
33.4670 -118.5002 
33.4326 -118.5007 
33.4000 -118.5012 



SMOOTHED INITIAL BEARING ANGLE 
FILTERED FINAL BEARING ANGLE 



106.68600 N 
100.29791 W 



VECTOR METHOD SOLUTION OF EMITTER LOCATION 
EMITTER LATITUDE = 33.24323 N 

EMITTER LONGITUDE =-117.49606 W 

EXTENDED KALMAN FILTER SOLUTION OF EMITTER LOCATION 
EMITTER LATITUDE = 33.23833 N 

EMITTER LONGITUDE =-117.45799 W 
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TARGET NUMBER 2 



FILTERED AND SMOOTHED EMITTER DATA CORRELATED TO TARGET NUMBER 2 



K FREO PRF 

2 1212.0 250.0 
4 1212.0 250.0 
6 1212.0 250.0 
8 1212.0 250.0 



PW 


THETAD 


3.00 


123. 1348 


3.00 


122.4821 


3.00 


120. 8329 


3 .00 


117.6429 



THTD 

123. 1348 
122.4821 
120.9605 
118.2154 



SLAD SLOD 

33.4856 -118.5002 
33.4498 -118.5004 
33.4160 -118.5004 
33.3836 -118.5015 



SMOOTHED initial BEARING ANGLE 
FILTERED FINAL BEARING ANGLE 



123.13493 N 
118.21536 W 



VECTOR METHOD SOLUTION 
EMITTER LATITUDE 
EMITTER LONGITUDE 



OF EMITTER LOCATION 
= 32.90477 N 

=-117.44853 W 



EXTENDED KALMAN FILTER SOLUTION OF EMITTER LOCATION 
EMITTER LATITUDE = 32.77782 N 

EMITTER LONGITUDE =-117.31906 W 
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Plot qf 



Figure 






ERRa.R CaunRIRHGtS OF EK^'GNQED KRLMRN EIlTER 
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j L|^J ! ! ; ! 1 ! ; ! 1 ] ! 1 ! 1 ! ; j ! 



14. a. Extended Kalman Filter Error Ellipse 
Associated with Lines-of-Bearing on 
Emitter 1. 
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Figure 14. b 
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Figure 14. c 
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Figure 14. d 
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DEGREES LONGITUDE 
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Figure 14. f 
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Figure 14. g 
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Figure 14. h 
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Figure 14. i 
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DEGREES LONGITUDE 



PLOT OF FRR(3R COURRlRNCfS OF EKTENDED KRLMRH FILTER 




Figure 14. j 
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DEGREEES LONGITUDE 



PLOT OF ERR3R CaURRJRNCFS OF EXTENDED KRLMRh FIlTER 
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DEGREES LONGITUDE 
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PLOT OF LRROR 00URRIRNCE3 OF EXTENDED KRLMRN FILTER 




Figure 15. a. ' Extended Kalman Filter Error Ellipse 
Associated with Lines-of- Bearing on 
Emitter 2 . 
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DEGREES LONGITUDE 
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DEGREES LONGITUDE 



PLOT OF FRROR C0URRIRNCE3 OF [:^^TEHQED KRLMRN FILTER 
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DEGREES LONGITUDE 



PLOT OF LRROR C0URRTRH0E5 OF EKTEHQED KRLHRH FILTER 




Figure 15. d 
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Figure 15. e 
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PLOT OF ERROR COURRIRNCES OF EXTENDED KRLMRN FILTER 
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DEGREiES LONGITUDE 



K 

1 

2 

3 

4 

5 

6 

7 

8 

9 

10 

11 

12 

13 

14 

15 

16 

17 

18 

19 

20 

21 

22 

23 

24 

25 

26 

27 

28 

29 

30 

31 

32 

33 

34 

35 

36 

37 

38 

39 

40 

41 

42 

43 

44 

45 

46 

47 

48 

49 

50 

51 

52 

53 

54 

55 

56 

57 

58 

59 

60 

61 

62 

63 

64 

65 



NAVIGATION DATA FILTER PARAMETERS 



SGI 



0.0 

1.00000 
0.99882 
0.98838 
0.98501 
0.99316 
0.98754 
0.98151 
0.97277 
0.94145 
0.94856 
0.91888 
0.85980 
0.83806 
0.85071 
0.92033 
0.86281 
0.86374 
0.90294 
0.92028 
0.95677 
0.93741 
0.94708 
0.90285 
0.83907 
0.88344 
0.95941 
0.94919 
0.92062 
0.98201 
0.96785 
0.96556 
0.96510 
0.96078 
0.97220 
0.93132 
0.91836 
0.96472 
0.95950 
0.89174 
0.88387 
0.98371 
0.97027 
0.98900 
0.92971 
0.86533 
0. 82393 
0.84651 
0.92028 
0.85657 
0.81387 
0 . 87628 
0.95511 
0.95369 
0 . 88339 
0 . S 8633 
0.88925 
0.87054 
0.94438 
0.95553 
0.95518 
0. 90990 
0. 85686 
0.89314 
0.90760 



SG 2 


SPll 


SP 12 


SP 22 


T 


0.0 


1.00000 


0.0 


1.00000 


0.0 


0 . 05119380.66919 


19.48511 


1.00038 


19.49 


0.05108 


1.14965 


0.05879 


0.00339 


19.51 


0.06558 


0.08664 


0.00575 


0.00060 


14.66 


0.04940 


0.08871 


0.00445 


0.00060 


19.44 


0.08664 


0.00135 


0 .00012 


0.00038 


0.13 


0.06699 


0.08112 


0.00550 


0.00059 


14.74 


0.06026 


0.05790 


0.00355 


0.00047 


15.71 


0.10268 


0.02173 


0.00229 


0.00033 


8.76 


0.08600 


0.01088 


0. 00099 


0. 00019 


9.74 


0.08194 


0.01346 


0.00116 


0.00022 


10.51 


0.15716 


0.00328 


0.00056 


0.00014 


4.17 


0.11550 


0.00249 


0.00034 


0.00008 


5 . 86 


0.13307 


0.00140 


0.00022 


0.00006 


3.91 


0.07386 


0.00388 


0.00034 


0.00013 


9.81 


0.12667 


0.00475 


0.00065 


0.00014 


5.93 


0.12924 


0.00202 


0.00030 


0 .00008 


4.63 


0.08069 


0.00394 


0.00037 


0.00012 


8,95 


0.13523 


0.00327 


0.00049 


0.00011 


5.06 


0.05688 


0.01188 


0.00073 


0.00027 


14.82 


0.14607 


0.00857 


0.00131 


0.00026 


5 . 58 


0. 06148 


0.01462 


0.00096 


0.00026 


14.05 


0.20048 


0.00123 


0.00026 


0.00020 


0.99 


0 .21650 


0.00257 


0.00062 


0.00017 


3,98 


0.10200 


0.00214 


0.00026 


0.00007 


5.91 


0.07841 


0.00506 


0.00045 


0. 00013 


9.61 


0.06027 


0.02470 


0.00155 


0.00033 


15,05 


0.18175 


0.00512 


0.00098 


0.00025 


3,95 


0.08575 


0.00783 


0.00073 


0.00016 


9 . 72 


0.11463 


0.00064 


0.00008 


0.00010 


0.17 


0.04331 


0. 04680 


0.00209 


0.00059 


22.39 


0.26431 


0.00448 


0.00123 


0.00051 


2.30 


0.09523 


0. 01888 


0.00186 


0.00028 


9.83 


0.06154 


0.02486 


0.00159 


0.00032 


14.62 


0.0906 1 


0.02435 


0.00227 


0.00032 


10.03 


0. 17870 


0. 00090 


0.00017 


0.00012 


0.96 


0.10144 


0.00690 


0.00076 


0.00016 


8 . 84 


0.04517 


0.03873 


0.00181 


0.00050 


20.40 


0.26424 


0.00315 


0.00087 


0.00042 


1.92 


0.32614 


0.00132 


0.00048 


0.00020 


2.30 


0. 07968 


0.00513 


0.00046 


0.00014 


9.70 


0.10944 


0.00061 


0.00007 


0.00010 


0 . 15 


0.03956 


0.05574 


0.00227 


0.00070 


24 . 59 


0.09726 


0.06107 


0.00601 


0.00070 


9.78 


0.13186 


0.00517 


0.00073 


0.00015 


5.63 


0.12222 


0.00233 


0 .00033 


0.00008 


5.17 


0.12997 


0.00128 


0. 00020 


0.00006 


3.95 


0.0 7313 


0.00376 


0.00032 


0. 00013 


9.82 


0.12684 


0.00475 


0.00065 


0.00014 


5.92 


0.13893 


0.00165 


0.00027 


0.00007 


3 . 97 


0.10611 


0,00171 


0.00022 


0.00006 


5.65 


0.08114 


0. 00449 


0.00042 


0.00012 


9 . 13 


0.06082 


0.02183 


0.00139 


0.00031 


14.77 


0.15795 


0.00706 


0.00117 


0.00025 


4.94 


0.12346 


0.00296 


0.00041 


0. 00010 


5.63 


0 .08152 


0 .00496 


0.00046 


0. 00013 


9 . 15 


0.17660 


0.00147 


0.00029 


0.00010 


2.64 


0.09397 


0.00385 


0.00042 


0. 00011 


8.23 


0.06346 


0.01623 


0.00109 


0.00026 


13.76 


0.17797 


0.00110 


0.00020 


0.00020 


0.74 


0.10369 


0.01350 


0.00147 


0.00024 


9.12 


0.13526 


0.00345 


0.00051 


0.00012 


4.92 


0.11034 


0.00246 


0.00032 


0.00008 


5.93 


0 .07766 


0.00575 


0.00050 


0.00014 


9.91 


0.15759 


0.00274 


0.00048 


0.00012 


4.02 
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NAVIGATION DATA FILTER PARAMETERS 



K VELND ELAT 



SLATD VELED ELON 



SLOND 



1 - 0.00097 

2 - 0.00097 

3 - 0.00097 

4 tO. 00094 

5 - 0.00097 

6 - 0.00096 

7 - 0.00097 

8 - 0.00095 

9 - 0.00092 

10 - 0.00090 

11 - 0.00094 

12 - 0.00095 

13 - 0.00097 

14 - 0.00100 

15 - 0.00095 

16 - 0.00095 

17 - 0.00097 

18 - 0.00096 

19 - 0.00092 

20 - 0.00083 

21 - 0.00072 

22 - 0.00066 

23 - 0.00074 

24 - 0.00060 

25 - 0.00064 

26 - 0.00070 

27 - 0.00069 

28 - 0.00071 

29 - 0.00071 

30 - 0.00069 

31 - 0.00069 

32 - 0.00072 

33 - 0.00070 

34 - 0.00070 

35 - 0.00069 

36 - 0.00067 

37 - 0.00065 

38 - 0.00070 

39 - 0.00080 

40 - 0.00058 

41 - 0.00067 

42 - 0.00074 

43 - 0.00070 

44 - 0.00064 

45 - 0.00069 

46 - 0.00068 

47 - 0.00070 

48 - 0 i 00066 

49 - 0.00066 

50 - 0.00061 

51 - 0.00067 

52 - 0.00069 

53 - 0.00070 

54 - 0.00070 

55 - 0.00071 

56 - 0.00069 

57 - 0.00067 

58 - 0.00069 

59 - 0.00071 

60 - 0.00072 

61 - 0.00075 

62 - 0.00072 

63 - 0.00069 

64 - 0.00073 

65 - 0.00073 



0.0 

0.0 

0.00003 
0.00047 
— 0. 00066 
0.00014 
- 0.00018 
0.00037 
0.00031 
- 0. 00078 
0.00055 
- 0.00005 
- 0. 00018 
- 0.00024 
0.00061 
0.00003 
- 0.00015 
0. 00008 
0.00032 
0.00166 
0. 00075 
0.00098 
- 0 . 00041 
0.00063 
- 0.00035 
- 0. 00076 
0.00015 
- 0.00012 
0 . 00008 
0 .000 14 
0.00002 
- 0.00012 
0.00024 
- 0. 00008 
0.00018 
0.00012 
0. 00017 
-0 .00108 
- 0. 00040 
0.00069 
-0 .00119 
- 0. 00060 
0.00096 
0.00058 
- 0.00037 
0.00014 
- 0. 00017 
0.00053 
- 0.00002 
0 . C 0034 
- 0.00049 
- 0.00032 
- 0.00012 
0 .00002 
- 0. 00008 
0.00017 
0 .00014 
- 0. 00020 
- 0. 00031 
- 0.00008 
- 0 . 00032 
0.00026 
0,00027 
- 0.00060 
0.00002 



33.35472 
33.33582 
33.31688 
33 .30269 
33.28491 
33.28412 
33.27011 
33.25467 
33.24670 
33. 23805 
33.22697 
33.22357 
33.21797 
33.21402 
33.20399 
33.19885 
33.19446 
33.18562 
33.18080 
33.16742 
33.16432 
33. 15494 
33.15518 
33. 15184 
33.14882 
33.14235 
33.13112 
33.12852 
33. 12146 
33.12140 
33.10605 
33. 10446 
33.09723 
33.08723 
33.08009 
33 .07959 
33.07331 
33.06073 
33.05833 
33.05611 
33.05110 
33.04994 
33.03119 
33.02527 
33.02220 
33.01826 
33.01570 
33.00870 
33.00523 
33.00259 
32.99940 
32.99294 
32.98242 
32.97885 
32.97493 
32.96838 
32.96669 
32.96130 
32.95168 
32 .95087 
32.94423 
32.94022 
32.93619 
32.92961 
32.92613 



0.00106 
0.00103 
0.00103 
0.00104 
0.00105 
0.00092 
0.00100 
0. 00103 
0.00110 
0.00103 
0.00099 
0.00099 
0. 00099 
0.00100 
0.00098 
0. 00103 
0.00100 
0.00100 
0.00103 
0 .00112 
0.00127 
0.00123 
0.00122 
0.00119 
0.00113 
0.00120 
0.00124 
0.00128 
0.00121 
0.00108 
0.00120 
0. 00147 
0.00125 
0.00123 
0.00124 
0.00118 
0.00121 
0.00123 
0.00137 
0. 00117 
0.00118 
0.00109 
0.00121 
0.00136 
0 . 00125 
0.00121 
0.00120 
0. 00120 
0.00128 
0.00126 
0. 00121 
0.00121 
0.00124 
0.00124 
0 . 00121 ' 
0. 00120 
0.00121 
0.00121 
0.00123 
0 .00118 
0. 00122 
0.00123 
0.00117 
0. 00119 
0.00127 



0.0 

0.00339 
0.00391 
0.00335 
0.00426 
0.00063 
0.00411 
0.00385 
0.00274 
0.00161 
0.00181 
0.00121 
0.00166 
0.00157 
0.00231 
0.00202 
0.00125 
0.00245 
0.00169 
0.00536 
0.00273 
0.00333 
0.00110 
0. 00096 
0.00155 
0.00379 
0.00463 
0.00162 
0.00183 
0.00074 
0.00810 
0.00211 
0.00024 
0.00341 
0.00285 
0.00095 
0.00251 
0.00590 
0.00152 
0.00003 
0.00295 
0.00110 
0.00895 
0.00425 
0.00102 
0.00151 
0.00169 
0.00319 
0.00262 
0.00161 
0.00165 
0.00284 
0.00454 
0.00146 
" 0.00168 
0.00262 
0.00141 
0 .00251 
0.00397 
0.00101 
0.00264 
0.00175 
0.00151 
0.00321 
0.00205 



- 120.90094 
- 120.88036 
- 120. 85689 
- 120.83792 
- 120. 81435 
- 120. 81000 
- 120.79581 
- 120. 77605 
- 120.76324 
- 120.74988 
- 120. 73749 
- 120 . 73164 
- 120. 72475 
- 120. 71945 
- 120.70831 
- 120.70053 
- 120. 69388 
- 120.68384 
- 120. 67664 
- 120. 65984 
- 120. 64865 
- 120, 62817 
- 120. 62331 
- 120. 61790 
- 120, 60997 
- 120.59779 
- 120 . 57643 
- 120.56711 
- 120.55310 
- 120. 55115 
- 120 .52617 
- 120.51556 
- 120.49902 
- 120 .48045 
- 120. 46437 
- 120 . 46089 
- 120. 44954 
- 120. 42265 
- 120.41460 
- 120.40997 
- 120. 39854 
- 120 .39574 
- 120. 36789 
- 120.34735 
- 120.33548 
- 120 . 32803 
- 120.32196 
- 120.30882 
- 120 . 29903 
- 120.29149 
- 120. 28296 
- 120.27060 
- 120. 25027 
- 120. 23978 
- 120 .23140 
- 120.21881 
- 120. 21332 
- 120 .20207 
- 120. 18315 
- 120. 17848 
- 120. 16670 
- 120. 15816 
- 120.14929 
- 120.13641 
- 120. 12874 
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LOB NUMBER ASSIGNED TO TARGET I 



1 2 3 4 5 



1 2 4 6 7 

3 20 24 30 35 

5 18 29 34 41 

8 13 16 23 25 

11 17 21 26 38 

12 22 47 52 56 

31 39 57 



6 


7 


8 


9 


10 


9 


10 


14 


15 


19 


43 


44 


50 


61 


65 


27 


36 


46 


49 


58 


45 

62 


51 


55 


60 





11 12 13 14 15 
28 32 33 37 40 
63 64 



16 17 18 
42 48 53 54 59 
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JSET DATA 



LOB NUMBER ASSIGNED TO TARGET I 



1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 



1 2 4 6 7 9 10 14 15 19 28 32 33 37 40 42 48 53 54 59 

3 20 30 35 43 44 50 61 65 

5 18 29 34 41 

8 13 16 46 49 

11 17 38 45 51 55 60 

12 22 47 52 56 

31 39 57 

24 

23 25 27 36 58 63 64 
21 26 
62 
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I 

1 

1 

I 

I 

I 

1 

1 

1 

1 

1 

1 

1 

1 

1 

1 

1 

1 

1 

1 

1 

2 

2 

2 

2 

2 

2 

2 

2 

2 

3 

3 

3 

3 

3 

4 

4 

4 

5 

5 

5 

5 

5 

5 

5 

6 

6 

6 

6 

6 

7 

7 

7 

9 

9 

9 

9 

9 

9 

9 

10 

10 



KALMAN FILTER PARAMETERS FOR ANGLE FILTER 



J 


K 


PI 1 (K) 


P12IK) 


GKK ) 


G2(K ) 


0 


1 


10000.0000 


0.0 


0.9858 


0.0 


2 


2 


3796832 .0000 


194851.0625 


1.0000 


0. 0513 


3 


4 


1524.5747 


32.8987 


0 .9137 


0.0197 


4 


6 


280.4939 


4. 7693 


0. 6608 


0.0112 


5 


7 


152.7203 


2.2873 


0.5147 


0.0077 


6 


9 


145.1893 


1.7950 


0.5021 


0 .0062 


7 


10 


91.3717 


1.0639 


0.3882 


0.0045 


8 


14 


95.3233 


0.9622 


0.3983 


0.0040 


9 


15 


69.6211 


0.6718 


0.3259 


0.0031 


10 


19 


73.6805 


0.6359 


0.3365 


0.0029 


11 


28 


144.8281 


0.8791 


0.5014 


0.0030 


12 


32 


113.2626 


0. 7491 


0.4403 


0.0029 


13 


33 


72 .4155 


0.4980 


0.3346 


0.0023 


14 


37 


79.2565 


0.5709 


0.3550 


0.0026 


15 


40 


73.2924 


0.5326 


0.3373 


0.0025 


16 


42 


56.1020 


0.4119 


0.2804 


0.0021 


17 


48 


93.4777 


0.6047 


0.3936 


0.0025 


18 


53 


96.7548 


0.6493 


0.4019 


0.0027 


19 


54 


61.8750 


0.4227 


0.3005 


0.0021 


20 


59 


76.1122 


0.5372 


0.3458 


0.0024 


0 


3 


10000.0000 


0.0 


0.9858 


0.0 


2 


20 


245938448.0000 


1568242.0000 


1 .0000 


0.0064 


3 


30 


538.0237 


3.6306 


0.7889 


0.0053 


4 


35 


290 .0398 


2.2160 


0.6682 


0.0051 


5 


43 


276.5554 


1.8841 


0.65 76 


0 .0045 


6 


44 


108.5593 


0.7722 


0.4298 


0.0031 


7 


50 


104.9692 


0.8097 


0.4216 


0.0033 


8 


61 


204.23S8 


1.2454 


0.5865 


0.0036 


9 


65 


1 17.2222 


0.8081 


0.4487 


0.0031 


0 


5 


10000.0000 


0.0 


0.9858 


0 .0 


2 


18 


105753904.0000 


1028366.6875 


1.0000 


0.0097 


3 


29 


676.7473 


4.5293 


0.8246 


0.0055 


4 


34 


240.9335 


1.6838 


0.6259 


0 .0044 


5 


41 


196.7235 


1.3391 


0.5774 


0.0039 


0 


8 


10000.0000 


0.0 


0.9858 


0.0 


2 


13 


15236810. 0000 


390341.7500 


1.0000 


0.0256 


3 


16 


364.8191 


7.4582 


0.7170 


0.0147 


4 


46 


6361 .5547 


22.8240 


0 .9779 


0.0035 


5 


49 


1 86.0658 


1.7933 


0.5637 


0.0054 


0 


11 


10000 .0000 


0.0 


0.9858 


0. 0 


2 


17 


11760551.0000 


342934.5625 


1 .0000 


0 .0292 


3 


38 


10214.9727 


49. 5509 


0. 9861 


0.0048 


4 


45 


334.0320 


2.8629 


0.6988 


0.0060 


5 


51 


190. 9865 


1.7584 


0.5701 


0 .0052 


6 


55 


155.5254 


1.3744 


0.5192 


0. 0046 


7 


60 


135.6935 


1.1037 


0.4852 


0.0039 


0 


12 


10000.0000 


0.0 


0.9858 


0.0 


2 


22 


61762576 .0000 


785891.0625 


1.0000 


0.0127 


3 


47 


2935.1575 


11.3428 


0.9532 


0.0037 


4 


52 


228.4055 


2. 1122 


0.6133 


0.0057 


5 


56 


186 .3982 


2.0266 


0.5642 


0.0061 


0 


31 


10000.0000 


0.0 


0.9858 


0 .0 


2 


39 


47449840.0000 


688837.8750 


1.0000 


0.0145 


3 


57 


1653.8228 


9.3628 


0.9199 


0.0052 


0 


23 


10000.0000 


0.0 


0.9858 


0.0 


2 


25 


977951 .8125 


98884.2500 


0.9999 


0.1011 


3 


27 


2646.6462 


86.8112 


0.9484 


0.0311 


4 


36 


2056.0347 


21.4738 


0.9345 


0.0098 


5 


58 


1380.1123 


5.8268 


0.9055 


0. 0038 


6 


63 


207.6056 


1.6897 


0.5905 


0 .0048 


7 


64 


101.2973 


0.9508 


0.4130 


0.0039 


0 


21 


10000.0000 


0.0 


0.9858 


0.0 


2 


26 


11934835.0000 


345466.2500 


1 .0000 


0 .0289 
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KALMAN FILTER PARAMETERS FOR ANGLE FILTER 



K 


T( K) 


THTD(K) 


TDTD(K) 


E( K) 


GATE(K) 


1 


0.0 


59.2273 


-0.0479 






2 


19.485 


57. 7483 


-0.0759 


-0.5454 


974 .2915 


4 


34. 179 


56.1255 


-0. 0549 


1.0632 


20.4241 


6 


19. 573 


55.1541 


-0.0532 


0. 1573 


10.3016 


7 


14.742 


53. 9223 


-0. 0599 


-0. 8703 


8.6128 


9 


24.466 


52.5216 


-0. 0591 


0.1281 


8.5028 


10 


9.744 


51.7402 


-0.0615 


-0.5299 


7.6709 


14 


24.439 


50.4772 


-0. 0591 


0.6015 


7.7350 


15 


9 .806 


49.6654 


-0.0613 


-0.7137 


7.3079 


19 


24.569 


47.8786 


-0.0637 


-0.8289 


7.3770 


28 


73.938 


42.7536 


-0. 0662 


-0. 8239 


8.4975 


32 


34.578 


40.5205 


-0.0659 


0.1300 


8.0197 


33 


9.831 


39.7742 


-0.0665 


-0.2954 


7.3555 


37 


34.441 


37.5330 


-0.0662 


0. 1419 


7.4709 


40 


24.613 


35.8449 


-0.0666 


-0.1759 


7.3704 


42 


9. 847 


35.1225 


-0. 0671 


-0. 2374 


7.0729 


48 


58.940 


31.0783 


-0.0677 


-0.2278 


7.7052 


53 


39.444 


28. 1404 


-0.0695 


-0.6683 


7.7581 


54 


4.937 


27.7536 


-0. 0698 


-0. 1458 


7.1742 


59 


39.424 


24.7081 


-0.0719 


-0.8522 


7.4181 


3 


0.0 


62. 3831 


-0.0473 






20 


156.824 


54.0991 


-0. 0528 


-0.8639 


7841.2148 


30 


69. 009 


51.0311 


-0.0489 


0.7317 


13.0578 


35 


59. 161 


48.0350 


-0. 0497 


-0. 1518 


10.4168 


43 


68.35 1 


46.0922 


-0.0396 


2.2497 


10.2537 


44 


9.783 


45.3923 


-0.0418 


-0.7265 


7 .9461 


50 


34.46 1 


43.0553 


-0.0487 


-2. 1226 


7.8894 


61 


83.767 


38.9379 


-0.0490 


-0.0577 


9.3306 


65 


24.765 


37. 8015 


-0.0484 


0.1693 


8 .0812 


5 


0.0 


76.3184 


-0.0423 






18 


102.837 


73.9504 


-0.0230 


1.9865 


5141.8398 


29 


88. 724 


70.5609 


-0.0320 


-1. 6330 


14.3243 


34 


49.304 


69.2111 


-0.0304 


0.3671 


9. 8099 


41 


54. 138 


67.6206 


-0.0300 


0.0988 


9.2293 


8 


0.0 


89.8662 


-0. 0351 






13 


39 .034 


87.7937 


-0.0531 


-0.7037 


1951.7271 


16 


19.638 


86. 8632 


-0.0508 


0.1565 


11.2785 


46 


251.067 


70.9110 


-0. 0623 


-3.2701 


40.3285 


49 


19.688 


69.7662 


-0.0615 


0.1441 


9.0839 


11 


0.0 


88.4148 


-0.0363 






17 


34.293 


86. 4644 


-0.0569 


-0.7063 


1714. 6934 


38 


187.198 


76.1742 


-0.0551 


0.3616 


50.8895 


45 


54.068 


72.2144 


-0.0635 


-1. 3999 


10.9320 


51 


34.479 


69.2354 


-0.0708 


-1.3831 


9.1513 


55 


34.468 


66.8928 


-0. 0699 


0.1874 


8 .6534 


60 


34. 529 


63.3594 


-0. 0790 


-2. 3061 


8.3620 


12 


0.0 


52.8601 


-0.0490 






22 


78.589 


44. 0398 


-0.1122 


-4. 9659 


3929 .4629 


47 


201.919 


34.5715 


-0.0612 


13.8409 


27. 7451 


52 


34.488 


32.3674 


-0.0621 


-0.1496 


9.6489 


56 


34.495 


28.9272 


-0.0762 


-2. 3011 


9. 0884 


31 


0 .0 


48.3618 


-0.0478 






39 


68.884 


44.3147 


-0.0588 


-0.7557 


3444.1973 


57 


132 .894 


37.7173 


-0. 0519 


1. 3159 


21 . 2004 


23 


0.0 


37.0618 


-0.0497 






25 


9.888 


36. 0716 


-0.1001 


-0.4992 


494 .4937 


27 


24.660 


36.3181 


-0.0111 


2.8634 


26.4133 


36 


73.959 


33.0763 


-0.0364 


-2.5942 


23.4523 


58 


172.273 


24.4576 


-0. 0463 


-2.5979 


19.5199 


63 


34 .46 6 


20.1427 


-0.0684 


-4.6048 


9.3756 


64 


9.906 


18.3441 


-0.0790 


-2.7139 


7.8310 


21 


0.0 


36.2854 


-0. 0497 






26 


34.547 


35.1806 


-0.0320 


0.6114 


1727.3518 
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TARGET NUMBER 1 



FILTERED AND SMOOTHED EMITTER DATA CORRELATED TO TARGET NUMBER 



K 


FREO 


PRF 




THETAD 


THTD 


SLAD 


SLOD 


1 


2872. 0 


320.0 


2.40 


59. 2273 


59.2273 


33.3547 


-120.8981 


2 


2872.0 


322.0 


2.50 


57.7483 


57.7483 


33.3358 


-120. 8769 


4 


2872. 0 


320.0 


2.50 


56.2173 


56.1255 


33.3031 


-120.8344 


6 


2872.0 


318.0 


2.40 


55. 2075 


55. 1541 


33.2842 


-120.8093 


7 


2872.0 


320.0 


2 .60 


53.5000 


53.9223 


33.2699 


-120. 7916 


9 


2872. 0 


319.0 


2.20 


52.5854 


52.5216 


33.2468 


-120.7605 


10 


28 72.0 


321.0 


2.50 


51.4160 


51.7402 


33. 2374 


-120.7481 


14 


2872.0 


320 .0 


2.60 


50.8391 


50.4772 


33.2140 


-120.7176 


15 


2872.0 


320.0 


2.20 


49. 1843 


49.6654 


33.2045 


-120.7058 


19 


2872.0 


320 .0 


2.40 


47. 3303 


47.8786 


33.1813 


-120.6743 


28 


2872.0 


319.0 


2.60 


42.3428 


42 .7536 


33.1284 


-120.5652 


32 


2872.0 


319.0 


2.50 


40. 5933 


40.5205 


33.1044 


-120.5135 


33 


2872.0 


320.0 


2 .50 


39.5776 


39.7742 


33.0974 


-120.4985 


37 


2872. 0 


320.0 


2.40 


37.6245 


37.5330 


33.0738 


-120.4462 


40 


2872.0 


320.0 


2.50 


35.7283 


35. 8449 


33.0555 


-120.4081 


42 


2872.0 


320.0 


2.50 


34.9517 


35.1225 


33.0494 


-120.3945 


48 


2872.0 


319.0 


2.30 


3 G. 9402 


31.0783 


33.0092 


-120.3054 


53 


2872 .0 


323.0 


2.80 


27.7407 


28.1404 


32.9823 


-120.2458 


54 


2872.0 


320.0 


2.50 


27.6516 


27 .7536 


32.9788 


-120.2381 


59 


2872.0 


322.0 


2.50 


24. 1506 


24.7081 


32.9514 


-120.1793 


SMOOTHED 


INITIAL BEARI NG ANGLE 


= 59.22725 N 





FILTERED FINAL BEARING ANGLE = 24.70815 W 



VECTOR METHOD SOLUTION 
EMITTER LATITUDE 
EMITTER LONGITUDE 



OF EMITTER LOCATION 
= 33.98700 N 

=-119.60393 W 
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TARGET NUMBER 2 



FILTERED AND SMOOTHED EMITTER DATA CORRELATED TO TARGET NUMBER 



K 


FREQ 


PRF 


PW 


THETAD 


THTD 


SLAD 


SLOD 


3 


2876.0 


306.0 


2.40 


62.3831 


62 .3831 


33.3169 


-120.8529 


20 


2878.0 


304.0 


2.40 


54.0991 


54.0991 


33. 1691 


-120.6545 


30 


2878.0 


306 .0 


2 .30 


51.1855 


51.0311 


33. 1215 


-120. 5503 


35 


2876.0 


306.0 


2.30 


47.9846 


48.0350 


33.0803 


-120. 4621 


43 


2876.0 


306.0 


2.4 0 


46.8625 


46 .0922 


33.0322 


-120.3590 


44 


28 76.0 


306.0 


2.30 


44.9780 


45.3923 


33.0258 


-120.3431 


50 


2876.0 


306.0 


2.50 


41.8276 


43.0553 


33.0027 


-120. 2898 


61 


2876.0 


3 06.0 


2.30 


38.9141 


38.9379 


32.9440 


-120.1640 


65 


2876.0 


3 06.0 


2.40 


37. 8948 


37. 8015 


32.9261 


-120. 1269 


SMOOTHED 


INITIAL BEARING ANGLE 


= 62.38292 


: N 





FILTERED FINAL BEARING ANGLE = 37.80147 W 



VECTOR METHOD SOLUTION 
EMITTER LATITUDE 
EMITTER LONGITUDE 



OF EMITTER LOCATION 
= 34.09401 N 

=-119.02849 W 
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TARGET NUMBER 3 



FILTERED AND SMOOTHED EMITTER DATA CORRELATED TO TARGET NUMBER 3 



K FREO PRF 

5 2846.0 370.0 
18 2846.0 370.0 
29 2846. 0 370.0 
34 2846.0 370.0 
41 2846.0 370.0 



PW 


THETAD 


2.30 


76. 3184 


2.30 


73.9504 


2.40 


70.2744 


2.40 


69. 3484 


2 .40 


67.6624 



THTD 

76.3184 

73.9504 

70.5609 

69.2111 

67.6206 



SLAD SLQD 

33.2843 -120.8101 
33. 1857 -120. 6813 
33.1215 -120.5511 
33.0872 -120.4769 
33.0495 -120.3957 



SMOOTHED INITIAL BEARING ANGLE 
FILTERED FINAL BEARING ANGLE 



76.31851 N 
67.62057 W 



VECTOR METHOD SOLUTION 
EMITTER LATITUDE 
EMITTER LONGITUDE 



OF EMITTER LOCATION 
= 33.78937 N 

=-118.17609 W 
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TARGET NUMBER 4 



FILTERED AND SMOOTHED EMITTER DATA CORRELATED TO TARGET NUMBER 4 



K FRED PRF 

8 5556.0 320.0 
13 5554.0 640.0 
16 5556.0 320.0 
46 5554.0 640.0 
49 5554.0 320.0 



PW 


THETAD 


1.00 


89.8662 


l.io 


87.7937 


1.00 


86.9075 


0.90 


70.8386 


1.00 


69.8291 



THTD 

89. 8662 
87 .7937 
86. 8632 
70.9110 
69.7662 



SLAD SLOD 

35.2550 -120.7721 
33,2177 -120.7229 
33.1988 -120.6985 
33.0182 -120.3263 
33.0054 -120.2964 



SMOOTHED INITIAL BEARING ANGLE 
FILTERED FINAL BEARING ANGLE 



89.86671 N 
69.76620 W 



VECTOR METHOD SOLUTION 
EMITTER LATITUDE 
EMITTER LONGITUDE 



OF EMITTER LOCATION 
= 33.25092 N 

=-119.49136 W 
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TARGET NUMBER 5 



FILTERED AND SMOOTHED EMITTER DATA CORRELATED TO TARGET NUMBER 5 



K FRED PRF 

11 5506,0 640,0 
17 5504.0 640.0 
38 5504.0 640,0 
45 5506.0 640.0 
51 5504,0 642.0 
55 5504.0 640,0 
60 5504.0 642.0 



PW 


THETAD 


0.60 


88.4148 


0.60 


86.4644 


0.60 


76.1792 


0.70 


71.7927 


0.60 


68.6409 


0.60 


66.9829 


0.60 


62. 1721 



THTD SLAD SLOD 



88.4148 33. 
86.4644 33. 
76.1742 33. 
72.2144 33. 
69.2354 32, 
66.8928 32. 
63.3594 32. 



2275 -120.7356 
1942 -120. 6923 
0597 -120.4169 
0218 -120.3343 
9989 -120.2809 
9749 -120.2294 
9508 -120.1774 



SMOOTHED INITIAL BEARING ANGLE 
FILTERED FINAL BEARING ANGLE 



88.41481 N 
63.35942 W 



VECTOR METHOD SOLUTION 
EMITTER LATITUDE 
EMITTER LONGITUDE 



OF EMITTER LOCATION 
= 33.25052 N 

=-119.45798 W 
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TARGET NUMBER 6 



FILTERED AND SMOOTHED EMITTER DATA CORRELATED TO TARGET NUMBER 6 



K FREO PRF 

12 2876.0 359.0 
22 2876. 0 359.0 
47 2876.0 359.0 
52 2874.0 359.0 
56 2876.0 359.0 



PW 


TFETAD 


2.20 


52.8601 


2.20 


44.0398 


2.40 


35. 2188 


2 .40 


32.3096 


2.20 


27.9243 



THTD 

52. 8601 
44.0398 
34. 5715 
32.3674 
28.9272 



SLAD 

33.2234 

33.1556 

33.0157 

32.9926 

32.9686 



SLOD 

120. 7302 
120.6249 
120.3198 
120. 2671 
120.2162 



SMOOTHED INITIAL BEARING ANGLE = 
FILTERED FINAL BEARING ANGLE = 



52.85960 N 
28.92722 W 



VECTOR METHOD SOLUTION OF EMITTER LOCATION 
EMITTER LATITUDE = 33.95410 N 

EMITTER LONGITUDE =-119.55852 W 
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TARGET NUMBER 7 



FILTERED AND SMOOTHED EMITTER DATA CORRELATED TO TARGET NUMBER 7 



K FREO PRF 

31 9268.0 500.0 
39 9268.0 499.0 
57 9270.0 500.0 



PW THETAD 

0.20 48.3618 

0.20 44.3147 

0.30 37.8228 



THTD 

48.3618 

44.3147 

37.7173 



SLAD SLOD 

33.1060 -120.5182 
33.0578 -120.4130 
32.9668 -120.2116 



SMOOTHED INITIAL BEARING ANGLE = 48.36174 N 
FILTERED FINAL BEARING ANGLE = 37.71735 W 



VECTOR METHOD SOLUTION OF EMITTER LOCATION 
EMITTER LATITUDE = 34.12042 N 

EMITTER LONGITUDE =-119.12958 W 
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TARGET NUMBER 8 



FILTERED AND SMOOTHED EMITTER DATA CORRELATED TO TARGET NUMBER 8 



K FREO PRF PW THETAD 

24 2676.0 305.0 2.40 19.1616 



THTD 



SLAD SLOD 

33.1525 - 120.6167 



SINGLE LINE BEARING 
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TARGET NUMBER 9 



FILTERED AND SMOOTHED 


EMITTER DA 


TA CORRELATED TO TARGET NUMBER 


K 


FREO 


PRF 


PW 


THE TAD 


THTD 


SLAD 


SLOD 


23 


55 56. 0 


640.0 


1.00 


37.0618 


37 .0618 


33.1548 


-120.6227 


25 


5556. 0 


320.0 


1.10 


36. 0715 


36. 0716 


33.1482 


-120.6078 


27 


5554. 0 


640.0 


1.10 


36.4658 


36.3181 


33. 1312 


-120. 5719 


36 


5554. 0 


640.0 


1.10 


32.9065 


33 .0763 


33.0797 


-120.4598 


58 


5556. 0 


640.0 


1.00 


24.2122 


24.4576 


32.9610 


-120. 1989 


63 


5556.0 


640 .0 


1.00 


18.2568 


20. 1427 


32.9362 


-120. 1472 


64 


5556.0 


320.0 


1.10 


16.7510 


18.3441 


32.9291 


-120.1331 



SMOOTHED INITIAL BEARING ANGLE = 
FILTERED FINAL BEARING ANGLE = 



37.06157 N 
18.34413 W 



VECTOR METHOD SOLUTION 
EMITTER LATITUDE 
EMITTER LONGITUDE 



OF EMITTER LOCATION 
= 34.27957 N 

=-119.59087 W 
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TARGET NUMBER 10 



FILTERED AND SMOOTHED EMITTER DATA CORRELATED TO TARGET NUMBER 10 

K FREO PRF PW THETAD THTD SLAD SLOD 

21 5504.0 640.0 0.60 36.2854 36.2854 33.1652 -120.6456 

26 5504.0 640.0 0.60 35.1807 35.1806 33.1417 -120.5935 

SMOOTHED INITIAL BEARING ANGLE = 36.28545 N 
FILTERED FINAL BEARING ANGLE = 35.18065 W 



VECTOR METHOD SOLUTION OF EMITTER LOCATION 
EMITTER LATITUDE = 35.15515 N 

EMITTER LONGITUDE =-118.84724 W 
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TARGET NUMBER 11 



FILTERED AND SMOOTHED EMITTER DATA CORRELATED TO TARGET NUMBER 11 



K FREO PRF PW THETAD THTD 

62 2874.0 359.0 2.40 59.5566 



SLAD SLOD 

32.9406 -120.1563 



SINGLE LINE BEARING 



160 



uoouocjocioooooooooocuooocjoooooooooooooooocooooocooooocoooooooooooooococoo 



MASTER CCNTROL PROGRAM 



DESCRIPTION OF VARIABLES IN THE COMMON BLOCK 

ACLAD 
ACL AMD 

ACLAR - AIRCRAFT LATITUDE READ FORM DATA 
ACLOD 
ACLOMD 
ACLOR 
ALT 
BRNG 
BRNGD 



AIRCRAFT LONGITUDE READ FROM DATA 
AIRCRAFT ALTITUDE 



F 

FREO 

G1 

G2 

GATE 

HDG 

HDGD 

MODEN 

MODET 

NST 

Pll 

P12 

P22 

PITCH 

PRF 

PRF 

PW 

ROLL 

SLA 

SLAD 

SLO 

SLOD 

T 

TIMEN 

TIMET 

TDTD 

THTD 

THTDl 

THETA 

THETAD 

TLAD 

TLOD 

VEL 

VELE 



VELN - 

XTDl - 
YTDl - 
Dll 



- CF BEARING ANGLE (TRUE OR RELATIVEt DEPENDING 
ON DATA SOURCE) 

- KALMAN FILTER ERROR -ERM IN ANGLE FILTER 

- SIGNAL FREQUENCY IN MEGACYCLES 

- KALMAN FILTER GAINS 

- TEST FOR DF BEARING CORRELATION 

- AIRCRAFT HEADING (TRUE) 

- MODE OF DATA COLLECTOR OPERATION 

- NUMBER OF DF BEARINGS CORRELATED TO A TARGET 



- ERROR COVARIANCE TERMS 

- LONGITUDINAL ATTITUDE OF AIRCRAFT 

- SIGNAL PULEE REPITION FREQUENCY 

- SIGNAL PULSE REPITION FREQUENCY 

- SIGNAL PULSE WIDTH 

- TRANSVERSE ATTITUDE OF AIRCRAFT 

- FILTERED AND SMOOTHED AIRCRAFT LATITUDE 



JST 



FILTERED AND SMOOTHED LONGITUDE OF AIRCRAFT 
TIME BETWEEN DATA SETS (SECONDS) 

TIME OF NAVIGATIONAL FIXES 
TIME OF TAKING DF BEARING 
DF BEARING ANGLE RATE 
FILTERED OF BEARING ANGLE 
SMOOTHED FIRST OF BEARING ANGLE 

DF BEARING ANGLE FROM DATA (TRUE) 

TARGET LATITUDE FROM ANGLE FILTERING 
TARGET LONGITUDE FROM ANGLE FILTERING 
AIRCRAFT SPEED OVER THE GROUND 

AIRCRAFT VELOCITY IN EAST DIRECTION (NEGATIVE 
DENOTES AIRCRAFT HEADING WEST) 

AIRCRAFT VELOCITY IN NORTH DIRECTION (NEGATIVE 
NUMBER INDICATES THAT THE AIRCRAFT IS HEADING 
TARGET LONGITUDE FROM EXTENDED KALMAN FILTER 
TARGET LATITUDE FROM EXTENDED KALMAN FILTER 
COVARIANCE OF ERROR OF SMOOTHED FIRST DF 
BEARING 

NUMBER OF DF BEARINGS FILTERED IN ANGLE FILTER 
BEFORE PROCESSING SWITCHED TO EXTENDED KALMAN 



VARIABLES COMMON THROUGHOUT PROGRAM 



JSET - MATRIX 
PTLAT - MATRIX 

CONES ASSOCIATED WITH 
PTLON - MATRIX OFLCNGITUDE OF 
CONES ASSOCIATED WITH 
NSTA - NUMBER OF DF BEARINGS 
JSTA - NUMBER OF DF BEARINGS 

SWITCHED TO 



RELATING DATA SETS TO TARGETS 
OF LATITUDE OF INTERSECTION OF 



ERROR 



EACH BEARING 
INTERSECTION OF ERROR 
EACH DF BEARING 
CORRELATED TO A TARGET 
FILTERED BEFORE 
EXTENDED KALMAN FILTER 
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COMMON ACL ADC 100) . ACLAMD( 100 ) » ACL AR ( 100) ,ACLO0(100) , 
lACLOMDC 100) . ACLORC 100 ) , ALT ( 1 00 ) » BRNGC 100) t BRNGDC 100 ) , 
2E( 100 ),F RE 0(100), G1(100),G2 (100) , GAT E ( 1 00 ) , HDG ( 100 ) , 
3HDGDC 100 ) , MCDENC 100 ) ,MODET ( 100) ,NST( 100) , PIK 100) , 
4P12( 100) ,P22 (I 00 ) , P ITCH( 100 ) ,PRF( 100 ) ,PW ( 100 ) , 

5RCLL (100).SLA( 100),SLA0(100) ,SLO( 100) ,SL0D( 100) , 

5T (100) . TIM EN( 100 ), TIMET ( 100) ,TDTD( 100) , THTD( 100) , 
6THTDK 100) ,THETA( 100) ,THETAD(100) , TL AO ( 1 00 ) , T LOD ( 100 ) , 
7VEL ( 100 ) ,VELE( 100 ) , VELN( 100) ,XTD( 100) , YTD( 100) , 
8D11(100),JST(100) 

DIMENSION JSET(15,50) , PTL AT ( 4, 1 5 , 50 ) , PTL ON (4 , 15 ,5 0 ) , 
1X3( 101 ) , Y3( 101 ) 

DATA IX/531/,STDEV/1 ./ , STDEVN/ . 5/ , AM EAN/ 0 . / 

DATA TEST/. 7/ 

DATA JDIM/2/ 

DATA SIGMA/1./ 

DATA RNAV/.25/ 

DATA RXTEND/.05/ 

KFLAG=1 

DATA EXTEST /3.0/ 

DATA RCUT.TSTCUT , JDIM /144.,.5,15/ 

CALL READ(NUM) 

CALL NAVINUM.RNAV, TEST ) 

CALL GEORGEC NUM, NTAR, RCUT,RXTEND, EXTESTtTSTCUT ,SIGMA, 
1JSET,PTLAT,PTLQN, JDIM) 



SUBROUTINE TO COMPUTE FINAL EMITTER TARGET JSET DATA 
WRITE(6,66 ) 

WRITE(6,202) 

WRITE(6,203) (K,K=1, 18) 

DO 30 I=1,NTAR 
NSTA=NST( I ) 

WRITE ( 6, 204) I, ( JSET( I , J) ,J=1,NSTA) 

30 CONTINUE 
K2 = 0 

WRITE(6,55) 

WRITE(6,53 ) 

DO 32 I=1,NTAR 
NSTA=:NST{I ) 

IF( NSTA.EO. 1 ) GO TO 32 
KI=JSET( 1,1) 

WRITE(6,64) I,K2,KI,P11(KI),P12(KI),G1(KI) ,G2(KI) 

JSTA=JST(I) 

DO 31 J=2,JSTA 
K=JSET ( I , J ) 

WRITE (6, 64) I, J,K,P11(K),P12(K),G1(K),G2(K) 

31 CONTINUE 

32 CONTINUE 
WRITFC 6, 55) 

WRITE(6,54) 

■ DO 35 I = 1,NTAR 
NSTA=NST( I ) 

IF(NSTA.EO. 1) GO TO 35 
KI=JSET( 1,1) 

WRITE! 6, 65) I ,K2 , KI ,T( KI ) ,THTD(KI ) ,TDTD(KI ) 

JSTA=JST ( I ) 

DO 34 J=2,JSTA 
K=JSET( I , J) 

WRITE (6, 65) I, J,K,T(K),THTD(K),TOTD(K) , E( K) ,GATE ( K) 

34 CONTINUE 

35 CONTINUE 

C 

DO 37 I=1.NTAR 
WRITE! 6,59) I 
NSTA=NST ( I ) 

WRITE(6,52) I 

IFCNSTA .FO. 1 ) GO TO 110 

JSTA = JST ( I ) 

DO 45 J=1,JSTA 
K=JSET( I , J ) 
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WRITE(6,51)(K,FRE0(K), PRF{K ) ,PW(K) ,THETAD( K) , THTD( K) ♦ 
ISLAD(K) ,SLOD(K) ) 

45 CONTINUE 

IF(A8S(TLAD( in .LE.lE-6) GO TO 46 
KF=JSET( I , JSTA ) 

WRITE (6, 68 ) THICK KF ), THTD( KF ) 

WRITE(6,70) TL AD( I ) ,TLOD( I ) 

IFINSTA .EO. JSTA ) GO TO 37 
KF=JSET ( I, NSTA) 

WRITE(6,71) YTD( KF ) ,XTD(KF) 

GO TO 37 

46 WRITE(6»205) 

GO TO 37 

no K=JSET(I,1) 

WRITE(6,67)K,FRE0( K ), PRF(K) ,PW(K) ,THETAD(K ), 

ISLAD(K) ,SLOD(K) 

WRITE(6, 200 ) 

37 CONTINUE 
C 

51 FORMAT (20X, I 3, F 7 . 1 1 F6 . 1 , F 5 . 2 , 4F 1 0. 4 ) 

52 FORMAT! 20X, 'FILTERED AND SMOOTHED EMITTER DATA', 

1* CORRELATED TO TARGET NUMBER ',12,///, 22X, *K', 2X, 
2'FREO', 3X, »PRF'. 3X, 'PW',4X, 'THETAD', 5X, 'THTD', 

36X. ' SLAD' , 6X, ' SLOD' ,/) 

53 FORMAT! 23X, ' I ' , 3X, 'J', 3X, 'K', 6X, •P11!K)»,8X, 

l'P12!K)', 6X, »G1!K)', 5X, ‘G2!K)',/) 

54 FORMAT! //, 23X, 'I', 3X, 'J', 3X, 'K', 3X, *T!K)',4X, 

l'THTD!K)’, 3X, 'TDTD!K)', 3X, 'E!K)',5X, 'GATE!K)»,/) 

55 FORMAT !' 1' , 29X , 'KALMAN FILTER PARAMETERS FOR ANGLE', 
1' FILTER', //) 

59 FORMAT! • 1', //////, 40X, 'TARGET NUMBER ',12,//) 

64 FORMAT! 20X ,314, F15.4,F13.4,2F10.4) 

65 FORMAT! 20X , 3 1 4 , F 9. 3 , F 1 0 . 4 , 2F 9. 4 , F 1 1 . 4) 

66 FORMAT!' 1' ,///,20X, 'FINAL JSET DATA',//) 

67 F0RMAT!20X, I3,F7.1 , F6 . 1 , F 5 c 2 , F 1 0 . 4 , lOX , 2 FIO . 4 ) 

68 FORMAT! // , 22X , ' SMCGTHE D INITIAL BEARING ANGLE =' , 
IFIO.5, * N', //, 24X, 'FILTERED FINAL SEARING ANGLE', 
2' =', FIO.5, ' W', //) 

70 FORMAT! //, 30X, 'VECTOR METHOD SOLUTION OF', 

1' EMITTER LOCATION',//, 36X, 'EMITTER LATITUDE =', 
2F10.5,' N',//, 35X, 'EMITTER LONGITUDE =', F10.5,' W') 

71 FORMAT! //, 25X, 'EXTENDED KALMAN FILTER SOLUTION OF', 

1' EMITTER LOCATION',//, 36X, 'EMITTER LATITUDE =', 
2F10.5, ' N',//, 35X, 'EMITTER LONGITUDE =', F10.5,' W') 

200 FORMAT!//, 40X, 'SINGLE LINE BEARING',//) 

202 FORMAT! ///,35X ,' LOB NUMBER ASSIGNED TO TARGET I',//) 

203 FORMAT ! 26X, 181 3, // ) 

204 FORMAT !20X, 13 , 3X, 3213) 

205 FORMAT! ///,30X, ' THE LINES OF BEARING DO NOT CROSS', 

1' ^',/, 30X, 'A THEREFORE NO SOLUTION IS POSSIBLE. ', 

2 '#.' ) 

STOP 

END 
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SUBROUTINE IMAV ( NUM , RN AV , T EST ) 



SUBROUTINE TO FILTER AND SMOOTH NOISY AIRCRAFT 
NAVIGATION DATA 

LIST OF VARIABLES 



All 

A12 

A21 

A22 

ELAT 

ELADl 

ELAD2 

FLON 

ELONl 

ELON2 

LEGl 

LEG2 

LW 

MW 

PIN 

PINll 

PIN12 

PIN22 

011 

012 
022 
SLAD 
SLATD 
SLOND 
SLOD 
SGI 
SG2 
SPI I 
SP12 
SP22 
SPKKll 
SPKK12 
SPKK22 
TT 

VELED 
VELEDS 
VELEM 
VELND 
VELNDS 
VELNM 
NLEG 
RNAV 



SMOOTHING FILTER GAINS 
LATITUDE FILTER ERROR TERM 

LATITUDE SMOOTHING FILTER ERROR TERM 
LONGITUDE FILTER ERROR TERM 



LONGITUDE 
SUBSCRIPT 
LEG 

LAST NAV FIX IN 
WORK VECTOR FOR 
WORK VECTOR FOR 
MINV ARGUMENT 



SMOOTHING FILTER 
CORRESPONDING TO 



A LEG 

MINV 

MINV 



ERROR 

FIRST 



T ERM 
NAV FIX 



IN A 



- INVERSE OF ERROR COVARIANCE MATRIX 



- VARIANCE OF SYSTEM 

- AIRCRAFT LATITUDE 

- PREDICTED AIRCRAFT 

- PREDICTED AIRCRAFT 

- AIRCRAFT LONGITUDE 

- KALMAN FILTER GAIN 



NOI SE 

LATITUDE ESTIMATE 
LONGITUDE ESTIMATE 



- ERROR COVARIANCE TERM - (K+llK) 



ERROR COVAR 
TIME INCREM 
AIRCRAFT VE 
SMOOTHED AI 
AIRCRAFT VE 
AIRCRAFT VE 
SMOOTHED AI 
AIRCRAFT VE 
NUMBER OF L 



- VARIANCE OF 



lANCE T 
ENT DIV 
LOCI TY 
RCRAFT 
LOCI TY 
LOCITY 
RCRAFT 
LCCI TY 
EGS 

MEASUR 



ERM - (KIK) 

IDED BY W 
EAST IN DEGREES 
VELOCITY EAST 
EAST IN KNOTS 
NORTH IN DEGREES 
VELOCITY NORTH 
NORTH IN KNOTS 

EMENT NOISE 



SUBROUTINE NAV ( NUM , RNA V , TE ST ) 

C 

COMMON ACLADI 100) , ACLAMDI 100) , ACLARI 100 ) , ACLODI 100 ) , 
lACLOMDI 100 ),ACLGR( 100) , ALT ( 100) ,BRNG( 100) ,BRNGD( 100) , 
2E(100),FREO(100),G1(100),G2(100 ) .GATE ( 100 ) ,HDG( 100 ) , 
3HDGDI 100),M0DEN( 100),M0DET( 100) ,NST(100) ,P11(100) , 

4 PI 2 (100 ) , P22 (100 ), P ITCH( 100 ) .PRF( 100) , PW( 100) , 

5R0LL( 100) ,SLA( 100) ,SLADSM(100) ,SL0(100) , S LCDS M( 100 ) , 
5T(100),TIMEN(100),TIMET( 100 ) , TDTD ( 100) .THTD(IOO) , 
6THTD1 (100) , THETA ( 100) , THETAD( 100 ) , TLAD( 100) , TLCD( 100) , 
7VEL( 100) ,VELE( ICO) , VELN( 100) . XTD ( 1 00 ) , YTD ( 1 00 ) , 
8D11(100),JST(100) 

DI ME NS I ON All ( 100 ) , A12 ( 100 ) , A21 ( 100 ) , A22( 100 ) . 
lELATI 100) . ELADl ( 100) ,ELAD2( 100) ,EL0N( 100) , ELONl ( 100) , 
2EL0N2( 100) , LEGl ( 50 ) , L E G2 ( 50 ) , L W ( 2 ) , MW ( 2 ) , P IN ( 2, 2 ) , 
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3PIN11(100),PIN12(100) ,PIN22( 100) ,011(100) ,012(100) , 
4022 (100) ,SLAD( 100 ) ,SLATD( 100) ,SL0ND( 100) , SL0D( 100) 
5,SG1( 100) ,SG2( 100) ,SP1 1(100) , S P12 ( 100 ) , S P22 ( 1 00 ) , 
6SPKK1K 100) ,SPKK12( 100),SPKK22( 100) ,TT( 100) ,VELED(100) 
7,VELEDS ( 100) ,VELEM( 100 ) , VELND( 100 ), VELNDS( 100) , 

8VELNM( 100) 

C 

DATA PI RAD/57. 29578/ 

PROGRAM TO FILTER NOISY MEASURED LATITUDE AND LONGITUDE 
DIVIDE THE FLIGHT TRACK INTO LEGS FOR FILTERING 
L=1 

LFGK 1) = 1 
DO 1 K=2,NUM 
K K = K~ 1 

TKM1=TIMET(KK) 

T(K)=TIMET(K)-TKM1 
IF(T(K) .LE. 120.0) GO TO 1 
LEG2(L )=KK 
LEGl ( L+1 )=K 
L = L+1 

1 CONTINUE 

LFG2 ( L) =NUM 
NLEG=L 

START OF KALMAN FILTER PREDICTION PROBLEM 

INITALIZE KALMAN FILTER 

00 100 L=1,NLEG 
LEG2L=LEG2(L ) 

LEG1L=LEG1 (L ) 

KI=LEG1L 
EL0N(KI ) = 0.0 
ELAT(KI )=0 .0 
T( KI ) =0.0 
SGKKI ) = 0.0 
SG2( KI )=0.0 
SPKKIK KI ) =1. 

SPKK12(KI )=0. 

SPKK22( KI ) =1. 

SP IKKI ) = 1. 

SP12(KI )=0. 

SP22(KI)=1. 

SLAD( KI )=ACLAD( KI ) 

SLATD(KI )= ACLAD(KI ) 

SLA( KI ) =ACLAR( KI ) 

VELND( KI)=(ACLAD(KI+1 )-ACLAD(KI ) ) /T( KI+1 ) 

SLONDIKI )=ACL0D(KI ) 

VELNM(KI )=VELND(KI )k216000. 

SLOD(KI )=ACLOD(KI) 

VELED(KI ) = ( ( ACLOD( KI+1 )-ACLOD(KI ) )/T (KI + l) )-?COS ( SLA ( KI 
VELEM( KI )=VELED( KI )''216000. 

START OF KALMAN FILTER RECURSION EQUATIONS 

LG1P1=LEG1L + 1 

CO 6 K=LG1P1,LEG2L 

KK=K-1 

TT(K)=T(K) /lOOO.O 
011(K)=TT(K)+t4/4.0 
012(K)=TT( K):>t'3/2. 0 
022(K) = TT(K)^t2 

COMPUTE KALMAN FILTER GAINS 

SPll (K)=SPKK11 (KK) + (2.0^-SPKK12(KK)+SPKK22(KK)^T(K) )* 
1T( K)+011( K) 

SP12(K) = SPKK12(KK)+SPKK22(KK);- T(K)+012(K) 

SP22( K) =SPKK22 (KK) +Q22 (K) 
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SG1(K) = SP11{K) /{SP11{K)+RNAV? T(K)/3600. ) 
SG2(K)=SP12(K)/ ( SPl 1(K )+RNAV« T(K) /3600. ) 

SPKKll (K) = SP11 ( K)*- (1.0-SGl (K)) 

SPKK12(K)=SP12 (K l.O-SGKK)) 

SPKK22 (K) = SP22 (K )-SP12 {K)'^SG2(K) 

FILTER LATTITUDE 

IFLAG=1 

70 0 SLATD(K) = SLAD( KK ) +V ELND ( KK ) T ( K ) 

ELAT(K)=ACLAD( K)-SLATD(K) 

TEST FOR EXCESS SYSTEM NOISE 

IF( ABS( ELAT( K) ) . LT.TEST) GO TO 800 

THE DATA POINT ACLAD(K) IS INVALID, SO IT IS DISCARDED 

IF( IFLAG.E0.2) GO TO 800 
ACLAD(KK)=SLATD(KK) 

ELAT( KK) =0. 

SLADIKK )=SLATD( KK) 

VELND( KK ) = VELND{ KK-1 ) 

VELNMI KK)=VFLNM( KK-1) 

SLAIKK )=SLAD(KK) /P IRAD 
IFLAG=2 
GO TO 700 
800 IFLAG=1 

THE DATA POINT ACLAD(K) IS VALID, SO PROCEED 

SLAD(K) =SLATD{K)+SG1(K):' ELAT(K) 

VELND(K)=VELND{KK) + SG2(K)-SELAT(K) 

VELNM(K)=VELND(K ):-’'2 16000. 

SLA( K) =SLAD( K) /PIRAD 

FILTER LONGITUDE 

900 SLOND(K)=SLOD( KK ) + VE LE D ( KK ) ^/=T ( K ) 

ELON(K) =(ACL0D(K )-SL0ND(K) )*C0S ( SLA ( K ) ) 

TEST FOR EXCESS SYSTEM NOISE 

IF( ABS(ELON( K) ) .LT.TEST) GO TO 1000 

THE DATA POINT ACLOD(K) IS INVALID, SO IT IS DISCARDED 

IF( IFLAG.E0.2) GO TO 1000 
ACLOD( KK)=SLOND(KK ) 

ELONI KK)=0. 

SLOD(KK)=SLOND(KK) 

•• VELED(KK) = VELED(KK-1) 

VELEMI KK) = VELEM( KK-1) 

IFLAG=2 
GO TO 900 
1000 IFLAG=1 

THE DATA POINT ACLOD(K) IS VALID, SO PROCEED 
SLODIK )=SL0ND( K )+SGl( K )-^ ELON(K) 

VELED (K) = { VELEDI KK ) +SG2 ( K)-> ELON( K) )^COS ( SLACK ) ) 

6 VELEMC K ) =VELED { K)-?216000. 

100 CONTINUE 

START OF FIXED INTERVAL SMOOTHING EQUATIONS 

DO 13 L=1.NLEG 
LEG2L=LFG2{L ) 

LEG1L=LEG1 (L ) 

N=LEG2L-LEG1L 
IF(N.LE.3) GO TO 11 
C 
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INI TALI ZF SMOOTHING FILTER 

SLADSMI LEG2L )= SLAD( LEG2L ) 

VELNDSI LEG2L) =VE LND( LEG2L) 

SLODSMI L£G2U = SL0D( LEG2L ) 

VELEDSI LEG2L)=VEL5C(LEG2L) 

COMPUTE SMOOTHING FILTER GAINS 

DO 10 I=1,N 

K=LEG2L-I 

KK=K+1 

PIN( 1« 1 )=SP11( K) 

PIN(1,2)=SP12(K) 

PIN(2,1)=SP12(K) 

PIN( 2, 2)=SP22( K ) 

CALL MINVIPIN, 2. DET,LW,MW) 

PIN11(K)=PIN(1 ,1 ) 

PIN12(K)=PIN( 1, 2) 

PIN22(K)=PIN(2,2) 

AIKK) = SPKK11( K)-' PINll (K)+SPKK12(K)!' (PINll (K)I'T (K ) + 
1PIN12(K)) 

A12( K)=SPKK11( K )'t*PIN12 (K )+SPKK12(K)>MPIN12(K)-?‘T( K ) + 
1P1N22( K) ) 

A21(K) = SPKK12( K )=: P I N1 1 ( K ) +SPKK 22 ( K ) ^ (PIN11(K)«^T(K) + 
1PIN12IK) ) 

A22( K) =SPKK12( K)^ PI N12 ( K) + S PKK22 ( K ) « (PIN12 (K)*T (K ) + 
1PIN22I K) ) 

SMOOTH LATITUDE ESTIMATES 

ELADl (K)=SLADSM(KK)-SLATD(KK) 

ELA02( K)=VELNDS( KK)-VELND(KK) 

SLADSMI K) = SLAD(K )+All (K)yELADl (K)+A12(K):LELAD2(K) 
VELNDSI K)=VELND( K)+A21 ( K ) * EL ADI ( K ) +A22 ( K )'^ELAD2(K) 
VELNDS(K) = VELND(K)+(A21(K)+A22( K) )>?:ELAD1(K) 
SLA(K)=SLADSM( K ) /P I RAD 

SMOOTH LONGITUDE ESTIMATES 

EL0N1(K)=(SLCDSM(KK)-SL0ND(KK) )*COS (SLA(K) ) 

EL0N2(K ) = ( VELEDSI KK )-VELED( KK) ) ^ COS ( SLA ( K) ) 

SLODSMI K) = SLOD (K ) + A 11 ( K ) '» ELON 1 ( K ) +A 12 ( K ) ?^E LON 2 ( K ) 
VELEDSI K) = VELED ( K) + A21 (K) « ELONl (K)+A22 (K)n< EL0N2 (K J 
SLO(K)=SLODSM( K) /PIRAD 

10 CONTINUE 
GO TO 13 

TO ANY LEGS WITH 3 OR LESS POINTS* ASSIGN THE DATA VALUES 
AS THE EILTERED AND SMOOTHED VALUES FOR THAT LEG 

11 .00 12 J=LEG1L, LEG2L 

SLADSMI J)=SLAD ( J) 

SLAU ) = SLAD( J ) /P IRAD 
VELNDSI J)=0. 

SLODSMI J)=SLOD( J) 

SLO( J)=SLOD( J) /PIRAD 

12 VELEDS(J)=0. 

13 CONTINUE 
WRITE(6,52 ) 

WRITE! 6, 53) 

WRITE! 6, 50) ! K , SG 1 ( K ) , SG 2( K ) , SP 1 1( K) , SP 12 ( K) , SP22 (K) , 

IT (K) , K=1 ,NUM) 

WRITE! 6,52) 

WRITE!6, 54) 

WRITE !6, 51 ) ( K, VELND!K) , ELAT !K) , SL AT D ! K ) , VELED! K ) , 
lELON! K) , SLOND! K) ,K=1, NUM) 

50 FORMAT! 24X. 14. 5F9.5, F9.2) 

51 FORMAT! 24X, 14, 2E9.5, F11.5, 2F9.5, F11.5) 

52 FORMAT! • 1* ,//////. 38X, 'NAVIGATION DATA FILTER', 

1' PARAMETERS',//) 

53 F0RMATI27X, ' K ' , 4X , ' SG 1 ' , 6X, 'SG2', 6X, 'SPll', 5X, 
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l'SP12', 5X, 'SP22', IX, 'T',//) 

FORMAK 27X, • K ' « 3X , ' VELND ' , 5X, 'ELAT', 7X, 
14X. 'VELED', 5X, 'ELCN', 5X, ' SLOND' , //) 
RETURN 
END 



' SLATD' , 
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c 

c 

c 

c 

c 

c 



SUBROUTINE 
1 SIGMA, JSET. 



GEORGE ( NUM, NTAR, RCUT,RXTEND, EXTEST , TSTCUT 
PTLAT, PTLCN, JDIM) 



THIS FORTRAN PROGRAM IS DESIGNED TO ANALYZE AND SORT 
ELECTRONIC EMITTER PARAMETERS AND AIRCRAFT NAVIGATION 
DATA, TO FILTER EMITTER DATA USING KALMAN FILTER TECH- 
NIQUES TO MINIMIZE BEARING ANGLE-OF-ARRI VAL MEASUREMENT 
NOISE, TO SMOOTH INITIAL UNFILTERED BEARING ANGLES, 

AND TO PREDICT EMITTER LOCATIONS USING VECTOR 
METHODS 



LIST OF VARIABLES NOT IN COMMON BLOCK 



NJSET - 

TDTDl - 

TPTD - 

TT 

Wll 

W12 

W21 

W22 

X3 

Y3 

SMOTHl 

SM0TH2 

SMOTH3 

SMOTH4- 

DELFRE- 

DELPRF- 

NTAR - 

RCUT - 

RXTEND- 

EXTEST- 

TSTCUT- 

SIGMA - 



DATA POINTS TO BE ASSOCIATED 
SMOOTHED BEARING RATE 
THETAD(K+ll K) 

VARIANCE OF SYSTEM NOISE 



TO A TARGET 



SMOOTHING FILTER GAINS 
X COORDINATE OF ERROR ELLIPSE 
Y COORDINATE OF ERROR ELLIPSE 



INTERMEDIATE TERMS IN SMOOTHING COMPUTATIONS 

CARRIER FREQUENCY TEST 

PULSE REPITION FREQUENCY TEST 

NUMBER OF TARGETS 

VARIANCE OF DF BEARING MEASUREMENT ERROR 
VARIANCE OF MEASUREMENT NOISE IN EXTEND 
MULTIPLIER FOR TEST TO SWITCH TO EXTEND 
MULTIPLIER FOR BEARING CORRELATION TEST 
MULTIPLIER TO VARY SIZE OF ERROR ELLIPSE 
DEEINED BY POINTS 



A«: 



SUBROUTINE GEORGE! NUM , NTAR , RCUT ,RXT END , EXTEST , TSTCUT , 
ISIGMA, JSET,PTLAT,PTLON, JDIM) 

COMMON ACLAD( 100) , ACLAMD! 100) ,ACLAR( 100) , ACLODdOO ) , 
lACLOMD! 100 ), ACLOR( 100) , ALT! 100) ,BRNG( 100) ,BRNGD! 100) , 
2E! 100) ,FRE0! 100) ,G1 ! 1 00 ) , G2 { 100 ) , GAT E ! 1 00 ) , HDG! 100), 
3HDGD! 100),MODEN! 100) ,MODET! 100) ,NST!100) ,P11!100) , 

4P12 ! 100 ) ,P22 ! 100 ), P ITCH! 100) ,PRF! 100) ,PW! 100) , 

SROLL! 100) , SLA! 100) ,SLAD!100) ,SL0!100) ,SL0D!100), 
5T!100),TIMEN! 100), TIMET! 100) , TDTD ! 1 00) , THTD ! 100 ) , 
6THTD1 ! 100) , THETA! 100) ,TH5TA0! 100),TLAD! 100) , TLQD! 100) , 
7VEL! 100) ,VELE! 100) , VELN! 100) , XTD ! 1 00 ) . YTD ( 1 00 ) , 
8D11!100J,JST!100) 

DI ME NS I ON JSET ! J DIM, 50 ) ,NJSET! 100 ) ,PTLAT ! 4, JDIM, 50), 
IPTLON! 4, JDIM.50),Q11!100),012I100),Q22!100), 

2T0TD1 !100) ,TPTD! 100 ) , TT ! 100 ) , W 1 1( 100),W12! 100) , 

3W21! 100) ,W22!100) ,X3!101),Y3!101) 

DATA PlRAD/57 .29578/ 

PROGRAM TO SORT EMITTER TARGET DATA AND ESTIMATE NUMBER 

OF DISTINCT EMITTER TARGETS 

DATA IS INITIALLY SORTED BY FREQUENCY AND PRF 

CUTERR=3 .5-T.SORT ! RCUT ) 

DO 1 1=1, NUM 
1 NJSET!I)=I 

NF=NUM 

DO 6 1=1, NUM 
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K=NJSET{ 1 ) 

JSET( I .1 )=K 
NSORT=NF 
NF=0 
NJ = 1 

DO 5 J=2.NS0RT 
KK=NJSFT( J > 

DELFRE=FREO(K)‘-FREO(KK ) 

DELPRF=PRF( K)-PRF(KK ) 

IF(ABS(DELFRE) .LE.30.0.AND.ABS(DELPRF).LE.10.) GO TO 4 

IF(A3S( DELFRE) .GT.30.0) GO TO 3 

IFt PRF ( K) . EQ.O. O.OR.PRFi KK ) .EQ.0.0 ) GO TO 4 

DO 2 L=2,2 

RK=L<-PRF(KK) 

TK=PRF( KK)/FLOAT(L) 

SK = PRF(K ) 

CK=ABS(RK-SK) 

DK=ABS( TK-SK) 

FK=Li?10 .0 

IF(CK.LE.FK.OR.DK.LE.FK) GO TO 4 

CONTINUE 

NF-NF+1 

NJSET( NF)=KK 

GO TO 5 

NJ=NJ+1 

JSETd .NJ)=KK 

CONTINUE 

NST ( I )=NJ 

IF(NF.LE.l) GO TO 7 
NT A R= 1 + 1 

IF(NF.FO.O) GO TO 8 
NTAR=NTAR+1 
JSET(NTAR. 1)=NJSET( 1) 

NST(NTAR)=1 
WRITE! 6,202) 

WRITE(6.203) (i<,K = i, 18) 

DO 9 I=1,NTAR 
NSTA = NST( I ) 

WRITE (6, 204) I, (JSET(I,J ),J=1,NSTA) 

CONTINUE 



PROGRAM TO FILTER NOISY MEASURED BEARING ANGLE THETAD(K) 
AND AIRCRAFT NAVIGATION DATA FOR EACH SUSPECTED EMITTER 
TARGET OF SIMILAR FREQUENCY AND PRF 

INITIALIZATION OF KALMAN FILTER EQUATION PARAMETERS 



IFLAG=1 

NTAR1=1 

NUMTAR=NTAR 

DO 27 I = NTAR1, NUMTAR 

NJ = 0 

NSTA2=NST( I ) 

NSTA=NST(I) 

IF(NSTA .EQ.l ) GO TO 27 
KI = JSET( I, 1) 

P11(KI)=10000.0 
P12( KI )=0.0 
P22(KI )=10000. 0 
OIKKI ) =0.0 
012(KI ) = 0.0 
Q22(KI )=G.O 
DIKKI )=1.0 
WIKKI )=1. 

W12(KI )=0. 

W2K KI ) =0. 

W22(KI )=1. 

G2(KI)=P12(KI)/(P11(KI )+RCUT ) 
G1{KI)=P11(KI)/(P11(KI)+RCUT) 
THTD(KI )=THETAD(KI ) 
THTD1(KI)=THETAD(KI ) 
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TDT01(KiT-T DTdIkI! ^ )'»' PI RAD/600000.0 

T(KI)=0.0~ 

START OF KALMAN FILTER PREDICTION PROBLEM 

DO 23 J=2,NSTA2 
11 K=JSFT(I,J) 

KK=JSET( I. J-1) 

TKM1=TIMET(KK) 

T(Ki=TIMET(KJ-TKMl 
TT(K)=T(K)/1000.0 
OlHK ) = TT(K)^-‘«=4/4.0 
012(K )=TT(K)>^^3/2.0 
022( K) =TT( K)‘««^2 

START OF KALMAN FILTER RECURSION EQUATIONS 



P11(K) = P11(KK)'^^( 1. O-GK KK) )+2.0*P12(KK)*T(K)-(P12 (KK)* 
IGl (KK) + P11 (KK)^G2(KK) )^T(K) + (P22(KK)-P12(KK)*G2(KK) 

2T( K)f <‘2+011( K) 

P12(K) = P12(KK) ^ ( l.O-GK KK) ) + ( P22( KK) -P12( KK)*G2( KK) 
1T(K)+012(K) 

P22( K) = P22( KK)-P12(KK)>«'G2(KK)+022(K) 

GKK ) = P11 (K) / ( PIKK )+RCUT) 

G2(K)=P12(K) / ( Pll (K)+RCUT) 

TPTD(K ) = THTD(KK)+TDTD( KK)^T{ K) 

12 E(K)=THETAD(K)-TPTD(K) 

THTO(K)=TPTD(K)+Gl (K)«-E(K) 

TDTD(K )=TDTD(KK )+G2(K )i^ E(K) 

CORRELATION GATING SCHEME TO ESTIMATE WHETHER FILTERED 
BEARING ANGLE THTD(K) IS AN EMISSION FROM EMITTER TARGET 
NTAR = I OR A SPURIOUS EMISSION 

GATE(K )=SORT(P 11(K)+RCUT)«TSTCUT 
IF(ABS(E(K) ).LT.GATE(K) ) GOTO 22 

13 IF( IFLAG.EO.l) GO TO 14 
IF(IFLAG.E0.2) GO TO 17 
GO TO 18 

14 IF(THETAD(KK).LT. 10.0. AND. THETAD(K).GT. 350.0) GO TO 15 
IF(THETAD(KK).GT. 350.0. AND. THETAD(K).LT. 10.0) GO TO 16 
GO TO 20 

15 THETADIK )=THETAD(K )-360.0 
THETA(K)=THETA (K)-6. 283186 
IFLAG=2 

GO TO 12 

16 THETAD(K)=THETAD(K)+360.0 
THETA(K)=THETA(K)+6.283186 
IFLAG=3 

GO TO 12 

17 THETAD(K)=THETAD(K)+360.0 
THETA(K)=THETAIK)+6.283186 
GO TO 19 

18 THETADIK )=THETAD(K )-360.0 
THETA(K)=THETA(K )-6.283186 

19 IFLAG=1 

20 NJ=NJ+1 

JSET (NTAR+1,NJ)=K 
NST( NTAR+1)=NJ 



THTD(K) IS A SPURIOUS BEARING LINE AND 
NEW TARGET. 

NST( I) = NST( I )-l 
NSTA2=NST( I ) 

IF(NSTA2.LT.J) GO TO 24 
DO 21 L=J,NSTA2 

21 JSET( I ,L)=JSET( I »L+1) 

GO TO 11 

22 IFLAG=1 



IS ASSIGNED TO A 
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C SMOOTHING EQUATIONS FOR FIRST BEARING LINE ESTIMATE 
C 

SMOTHl=l .0-Pll i K!<):* ( 1. 0-Gl (KK) ) /RCUT 
SM0TH2 = SM0TH1'^:T (K ) 

SM0TH3=-P12 (KK)t' a .0-Gl (KK) )/RCUT 
SM0TH4= 1 o O+SMO TH3-.'T ( K ) 

W1 1 ( K ) =W 1 1 ( KK ) S MOT Hl + W 12 ( KK ) ^-S MOTH2 

W12( Kl =W1 1( KK)«SM0TH3+W12 (KK)^ SM0TH4 

W21 tK)=W21(KK) I' SM0THH-W22( KK)-:-SM0TH2 

W2 2 ( K ) = W2 1 ( KK ) •• S MO T H3+ W2 2 ( KK ) S MOT H4 

D1 1 ( K ) =D 1 1 ? KK ) - W n ( K ) ‘t* 2 ^’- ( PI 1 ( KK ) +RCUT) / RCUT!*:^2 

THTDK K j=THTDl i KK ) + (W 1 1 (K ) /RCUT)-f E( K) 

TDTDK K)=TDT01 ( KK) + { W2 1 ( K ) /RCUT )^^E( K ) 

JST( I )=J 

IF(P11 (K ) eLT. ( EXTEST-^S^RCUT ) ) GO TO 25 

23 CONTINUE 
C 

C FILTERED BEARING ANGLE THTD(K) IS CORRELATED TO EMITTER 
C TARGET NTAR = I 
C 

24 IF(NSTA2 .NE.NSTA ) NTAR=NTAR+1 
IF(NSTA2.E0. 1 ) GO TO 27 

C 

C PROGRAM TO COMPUTE TARGET POSITION 
C 

KI=JSET( 1,1) 

KF=JSET( I.NSTA2) 

CALL PREPAR ( K I , KF , S LAD , SLOD , THTDl ( K F) , THTD( KF ) f 
1TLAD( I ) ,TLOD( I ) ) 

GO TO 27 
C 

C PROCESSING SWITCHES TO EXTENDED KALMAN FILTERING 
C 

25 CALL POINTSd.J, SIGMA, RCUT, Dll, HDGD,JSET,P11,SLAD, 
1SL0D,THTD1,THTD, PTL AT , PTLON , J D I M , S27 ) 

DO 26 N=l,4 

X3( N ) = P 1 LON ( N, I , J ) 

26 Y3(N)=PTLAT(N, I, J) 

CALL EXTENDI I , J ,NSTA2 , RXTEND , TSTCUT , JSET , NST , SL AD, 

1 SLOD, T, THETA, THETA D,THTDl,THTD,TLAD,TLOD,XTD,YTD,X3, 
2Y3, JDIM) 

IF(NSTA2. NE.NSTA) NTAR=NTAR+1 

27 CONTINUE 

IF( NUMTAR. EO.NTAR) RETURN 
NTAR 1=NUMTAR+1 
GO TO 10 

202 FORMAT! ‘ 1' ,35X ,' LOB NUMBER ASSIGNED TO TARGET I*,//) 

203 FORMAT! 26X, 181 3, //) 

204 FORMAT (20X, 13 , 3X, 3213) 

END 
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SUBROUTINE EXTENDd , J , N STA , RXT END » TSTCUT , J SE T , NST , 
1SLAD.SL0D,T,THETA, THETAD» THTD 1 » THTD , TLAD » TLOD , XTD t 
2YTD.X3.Y3, JDIM) 



SUBROUTINE TO COMPUTE EMITTER 
KALMAN FILTERING TECHNIQUES. 

LIST OF VARIABLES 



LOCATION USING EXTENDED 



I 

J 

A 

C 

ALPHA - 

THETA - 

SLAD 

SLA 

SLOD 

SLO 

NST 

RXTEND - 

1ST CUT - 

YT 

YTD 

TLAD 

XT 

XTD 

TLOD 

ATI 

AT2 

TX 

DMX/DM - 
DMY/DM - 



GY 
GX 
ER 

NSTA 

GATE 

Pll 

P12 

P22 

011 

012 
022 
EPll 
FP12 
EP22 - 

G1 

G2 

XTDDOT 
XTDl - 
YTDl - 
YTDDOT- 
EX 
EY 



TARGET NUMBER 

CUT NUMBER CORRELATED TO TARGET I 
SEMI-MAJOR AXIS OF ERROR ELLIPSE 
SEMI-iMINOR AXIS OF ERROR ELLIPSE 
ANGLE OF ROTATION OF ERROR ELLIPSE 
VECTOR OF DF BEARINGS 

A/C LATITUDES IN DEGREES 
A/C LATITUDES IN RADIANS 
A/C LONGITUDES 
A/C LONGITUDES 

NUMBER OF CUTS IN EACH TARGET 
OF MEASUREMENT NOISE 
USED TO VARY SIZE OF GATE 
OF TARGET 
OF TARGET 
OF TARGET 
OF TARGET 



OF 

OF 

OF 

OF 

OF 



VECTOR 
VECTOR 
VECTOR 
VECTOR 
VECTOR 
VARIANCE 
VARIABLE 
LATITUDE 
LATITUDE 
LATITUDE 
LONGITUDE 



LONGITUDE OF TARGET 
LONGITUDE OF TARGET 
DISTANCE FROM TARGET TO A/C IN 
DISTANCE FROM TARGET TO A/C IN 
REARING FROM A/C TO TARGET 
RATE OF CHANGE OF DF BEARING WITH 
TO CHANGE OF LONGITUDE OF TARGET 
RATE OF CHANGE OF DF BEARING WITH 
TO CHANGE OF LATITUDE OF TARGET 

- KALMAN FILTER GAIN IN Y 

- KALMAN FILTER GAIN IN X 



DEGREES 

DEGREES 



RESPECT 

RESPECT 



DF BEARING ERROR 
NUMBER OF CUTS CORRELATED TO TARGET I 
TEST OF CORRELATION OF DF CUTS 
VARIANCE OF ERROR IN LONGITUDE 
COVARIANCE OF LATITUDE ERROR WITH 
LONGITUDE ERROR 
VARIANCE OF ERROR IN LATITUDE 
COVARIANCE OF SYSTEM ERRORS 
COVARIANCE OF SYSTEM ERRORS 
COVARIANCE OF SYSTEM ERRORS 



POS ITION 
FILTERS 



ERROR COVARIANCE TERMS FOR LINEAR 



LINEAR FILTER GAINS 
■ XTDK K-4-1 IK) 
ESTIMATE OF TARGET 
ESTIMATE OF TARGET 
YTDK K+1 IK) 
LONGITUDE ERROR 
LATITUDE ERROR 



LONGITUDE 

LATITUDE 



SUBROUTINE EXT END( I , J , N STA , RXTEND , TSTCUT , J SE T ,NST , 

1 SLAD, SL OD, T, TH ET A, THETA D,THTD1,THTD, TLAD, TLOD , XTD , 
2YTD,X3,Y3, JDI M) 

DI ME NS I ON Pli( SO ) , P12 (80) , P2 2(80 ) ,XT(80 ) ,XTD(80) , YT( 80 
1YTD(80) , SLA( 80) , SLAD( 80) ,SLO( 80) , SLOD (80) , THETA (80) , 
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2NST(80) , ER 180) ,TX180) ,DMX( 80) , DMY ( 8 0 ) , GX ( 80 ) , 

3GY(80) .TLADOO) ,TLGD(30) , 01 1 ( 80 ) , 012 ( 80 ) » 022 ( 80 ) , 

4T( 1), JSETUDIM . 50) « TT( 80) .GATE ( 80) .THETAD ( 1 ) . EPl 1 { 80 ) , 
5EP12(80) .EP22( 30 ).G1(80).G2(80) ,XTD1( 80),XTDD0T( 80) , 
6XTDHAT( 80) ,YTD1( 30) ,YTDD0T(80) ,YTDHAT(80) , EX(80), 
7EY(80) .THTDK 1 ) , THT D ( 1 ) . X3( 4) . Y3 ( 4) . Z ( 4 ) , XX ( 10 1 ) , 

8YY( 101 ) 

C 

DATA PIRAD/57. 29578/ 

EXTENDED KALMAN FILTER INITIALIZATION 

WRITE(6. 102 ) J, I 
K1=JSET{ 1,1) 

KI=JSET( I, J ) 

CALL PREPAR ( K1 , KI , SL AD , S LOD , THTDl ( K I ) , THT C ( K I ) , 

1TLAD( I ) , TL0D( I ) ) 

TLAD. TLOD IS THE CURRENT ESTIMATE OF THE TARGET 
POS ITION. 



X3,Y3 ARE THE LOCATIONS OF THE INTERSECTIONS OF THE 
EDGES OF THE TWO ERROR CONES. 

TLA=TLAD( I ) /PI RAD 
DFLX=(X3(1)-X3(2) I^j^COSlTLA) 

DELY=Y3( 1)-Y3l 2) 

ALPHAl=ATAN2l DEL X, DELY) 

ALPHA2=ALPHA1-1 .5737963 
ALPHAD = ALPHA1-^PIRAD 

ALPHAD IS THE ANGLE OF ROTATION OF THE ELLIPSE 

DELX=(TLODl I )-X3l 2) )^=C0S{TLA) 

DELY=TLADi I ) -Y3 12 ) 

A = SORT(DELX*>!^2 + DELY^-*2) 

A IS THE SEMI-MAJOR AXIS 

DO 19 K = 3.4 

DELX=(TLOD( I )-X3 IK) )t^C0S (TLA) 

DFLY=TLAD( I )-Y3l K) 

BETA = ATAN2l DELX, DELY) 

GAMMA=ALPHA2-BETA 

19 Z(K)=SORT( DELX*-t^2+DELY=^^>5^2)^-COS(GAMMA) 

C=(ABS(Z(3) )+ABSlZl4) ) )/2.0 

C IS THE SEMI-MINOR AXIS 

WRITEt6,l03) ALPHAD, A, C 

• INITIALIZE THE KALMAN FILTERS 

WRITEC6, 56) 

YTD(KI )=TLADl I ) 

XTD( KI )=TL0Dl I ) 

XTIKI )=XTD{KT) /PIRAD 
YT(KI )=YTD(KI) /PIRAD 
SLAl KI )=SLAD(KI ) /PIRAD 
SLO( KI )=SLODlK I ) /PIRAD 
CA=COS ( ALPHAl ) 

SA=SIN( ALPHAl ) 

Pll (K I )= ( A'»SA ) ;!c»2+ ( C=^CA )^'->=2 
P12(KI ) = SA-^CA¥ ( A*-?2-C-T;-'2) 

P22(KI )= (A-‘-CA) f"2+lC^-SA)=^:*2 
AT1 = IXT(KI )-SLO(KI ) )^ COS ( YT ( KI ) ) 

AT2=YT( KD-SLA I KI ) 

TX(KI )=ATAN2l AT 1,AT2) 

ER(KI )=THETA(KI)-TX(KI ) 

OM=( YTD( KI )-SLAD (KI ) ) 2+ ( XT D( K I ) -SLOD( K I ) )*^2 
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1:>(C0S(YT(KI ) 

DMX(KI) = (YTD{KI)-SLAC(KI) ) ^'COS ( YT ( K I ) ) / DM 
DMY(KI )=-( XTD( KI )-SLOD( KI ) )^^ ( ( YTD{KI )-SLAD(KI) 

IS IN(YT (KI) )+COS (YT (KI ) ) )/DM 
DG=Pll (KI )^DMX( KI ).^"’i‘2+2-0-1'Pl2 (KI ):^DMX(KI)^DMY{KI ) 
1 + P22(KI )’-:-DMY(K I 2+RXTEND 

GX(KI ) = ( Pll { KI J*DMX (KI ) + PI 2 ( K I ) :^DMY ( K I ) ) /DG 
GY( KI ) = ( P12( KI )■: DMX( KI ) + P22(KI)t.DMY(KI ) ) / DG 
EPIKKI ) = P11(KI) 

EP12(KI )=P12(KI) 

EP22(KI )=P22(< I ) 

G1 (KI) = EP11(KI I/ (EPll (KI )+RXTEND) 

G2(KI )=FP12(KI ) / (EPll ( KI )+RXTEND) 

EX(KI )=0.0 
EY(KI )=0,0 
XTDDOK KI ) =.001 

XTDl (K I )=XTD(KI )+GX(K I )'4ER(KI ) 

YTDOnKKI ) = .001 

YTDKKI )=YTD(KI ) +G Y ( K I ) 'S- ER ( KI ) 

START OF KALMAN FILTER PREDICTION PROBLEM 

COMPUTE GAINS FOR LINEARIZED FILTER 

NSTA=NST( I ) 

JP1=J+1 

DO 12 JJ=JP1,NSTA 
20 K-=JSFT{ I ,JJ ) 

KK=JSET( I,JJ-1) 

SLA(K)=SLAO(K)/PIRAD 

SL0( K)=SLOD( K) /PIRAD 

TT(KJ=T(K)/1E3 

Oil ( K) =TT( K)*':-4/4. 0 

012(K ) = TT(K)«-*3/2. 0 

022(K) = TT(K)A^^2 



START OF EXTENDED KALMAN FILTER RECURSION EQUATIONS 

P11(K)=P1I(KK)':’! (1.0-GX(KK)=5DMX(KK))-P12(KK J^GX(KK)^ 
10MY(KK)+011(K) 

P12 (K) = P12 (KK)‘J:( 1 .0-GX (KK)^*DMX(KK) )-P22(KK )s5GX(KK)* 
1DMY( KK)+Q12( K) 

P22 (K) = P22(KK) 1 . 0-GY ( KK ) *: DMY ( KK ) ) -P 12 ( KK ) *G Y( KK)^ 

1DMX(KK) + Q22 (K) 

OM=( YTD( KK)-SLAD { K) 2+ ( XTO ( KK ) -S LOD ( K ) 

l;5'(CnS(YT(KK) )} A^2 

DMX(K) =( YTD(KK)-SLAD(K) )i^^COS ( YT ( KK ) )/DM 
DMY(K)=-(XTD( <K)-SLOD (K) )*( ( YT D ( KK ) -SL AD ( K ) ) 

1SIN( YT( KK) )-i-CGS { YT( KK) ) ) /DM 
D G = P 1 1 ( K ) ■ :* D M X ( K ) : - 2 + 2 . 0 P 1 2 ( K ) ^ ■ D M X ( K ) D M Y ( K J + 

1 P22( K)-'-DMY( K )r;«^;2 + RXT EN D 
GX(K)=( Pll(K)i:DMX( K ) + P 1 2 ( K) ^ DMY ( K ) )/DG 
GY(K) = ( P12(K)’>DMX(K ) + P 22 ( K ) ^‘DMY ( K ) ) /DG 
AT1 = (XT (KK) -SLOCK) )^^C0S(YT(KKn 
AT2=YT( KKJ-SLA ( K ) 

TX (K)=AT AN2 ( ATI . AT2 ) 

1 ER(K)=THETA(K)-TX( K) 

CORRELATION GATING SCHEME TO ESTIMATE WHETHER FILTERED 
BEARING ANGLE THTDCK) IS AN EMISSION FROM EMITTER TARGET 
NTAR = I OR A SPURIOUS EMISSION 

GATE(K)=S0RT(P11 ( K ) +RXTEND) 4^ TSTCUT 
IF( ABS( ER( K ) ) .LT .GATE( K) ) GO TO 11 

2 IF( IFLAG.EO.l ) GO TO 3 
IF( 1FLAG.E0.2) GO TO 6 
GO TO 7 

3 IF(THETAD(KK).LT. 10.0. AND. THETAD(K).GT. 350.0) GO TO 4 
IF(THETAD(KK).GT.350.0.AND.THETAD(K) .LT.10.0) GO TO 5 
GO TO 9 

4 THETA(K)=THETA(K)-6. 203186 
IFLAG=2 
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GO TO 1 

5 THPTA(K)=THETA( K)+6. 283186 
IFLAG=3 

GO TO 1 

6 THETA(K)=THETA(K)+6. 283186 
GO TO 8 

7 THETA(K)=THETA(K)-6. 283186 

8 IFLAG=1 

9 NJ=NJ+1 

JSET (NTAR+1»NJ)=K 
NST(NTAR+1)=NJ 

THTD(K) IS A SPURIOUS BEARING LINE AND IS ASSIGNED TO A 
NEW TARGET. 

NST( I) =NST( I )-l 
NSTA=NST( I ) 

IF(NSTA.LT.JJ) GO TO 13 
DO 10 L=JJ,NSTA2 

10 JSET(I,L)=JSET( I,L+i; 

GO TO 20 

11 1FLAG=1 

COMPUTE GAINS FOR LINEAR FILTERS 

EP11(K) = EP11(KK)^( l.O-GKKK) ) + 2 . O-’^EP 12 ( KK ) *T( K)- 
1 ( EP12(KK)!?.-G1 (KK) +EP11 ( KK )tG2(KK ) ) ^T ( K ) + ( EP22 ( KK ) - 
2EP12( KK)-VG2( KK) ) ^^T ( K) 2+01 1 ( K ) 

EP12 (K) = EP12(KK ):M l.O-GKKK) ) + ( EP22 ( KK ) -E P 12 ( KK) * 

2G2( KK) )-?K(K)+012 (K) 

EP22(K )=EP22(KK )-EP12( KK)’f^G2( KK)+Q22( K) 

G1(K)=EP11{K)/ ( EPll (K )+RXTEND) 

G2(K)=EP12(K)/( EPll (K)+RXTEND) 

FIND BEST ESTIMATES OF TARGET LONGITUDEt XTDl, AND TARGET 
LATITUDE. YTDl 

YTDHAT(K) = YTD( KK ) +YTDDOT { KK ( K ) 

EY( K) =YTD1 ( KK) -YTDHATC K) 

YTD(K ) = YTDHAT( K) +GKK )---EY( K) 

YTDDOT ( K )=YTDDOT ( KK ) +G2 ( K )-*S EY ( K ) 

YTDK K)=YTD( K)+GY( K)^’ER(K) 

YT(K)=YTD1(K)/PIRAD 

XTDHATI K)=XTD( KK ) +XTDDOT ( KK )*T{ K ) 

EX(K )=( XTD1(KK)-XTDHAT( K) )^-COS( YT(K) ) 
XTD(K)=XTDHAT(K)+G1 (K)TEX(K) 

XTDDOTt K) = (XTDOOT( KK)+G2 (K ):^EX(K) )^iCOS(YT (K) ) 

XTDKK ) = XTD( K ) +GX( K ER { K) 

XT(K)=XTD1 (K)/PIRAD 

12 CONTINUE 

13 WRITE(6.51) 

DO 14 JJ=J.NSTA 
K=JSET( I ,J J) 

14 WRITE(6,52)K,P11{K).P12(K),P22(K),GX(K).GY(K) 
WRITE(6,50) 

DO 15 JJ=J,NSTA 
K=JSET ( I , JJ ) 

15 WRITE (6. 53) K.DMXf K ) ,DMY( K) , TX ( K ) . ER( K ) , XT D ( K ) , YT D ( K ) 
WRITE! 6, 56) 

WRITE (6, 54 ) 

DO 16 JJ=J,NSTA 
K=JSET( I , JJ ) 

16 WRITE{6.52)K,EP11{K).EP12{K),EP22(K),G1(K),G2(K) 

WRI TE( 6. 55 ) 

DO 17 JJ=J.NSTA 
K=JSET ( I , J J ) 

17 WRITE! 6.53) K.E X( K) , EY( K) .XTDDOTIK) .YTDDOT! K) .XTDKK ) . 
1YTD1!K) 



50 


FORMAT! 


// 


. 22X. 'K*. 4X. 


•DMX’ . 6X. 


' DMY» . 


6X. *TX' 




17X. 'ER" 


« 


8X. 'XTD*. 7X, 


' YTD* , /) 
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FORMAT ! 


// 


, 22X. ' K’ . 5X. 


• Pll ' . 8X. 


•P12* . 


8X. •P22* 
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17X, 'GX» , 6Xf ' GY' , /) 

52 FORMAT (20X, I3,3E11 .3, 3F8.3) 

53 FORMAT ( 20X,I3,4F 9.4,F11.4.F10.4) 

54 FORMAT(//, 22X, 'K', 4X, ' EP 1 1 • t 7X» • EP12 • , 7X, 'EP22', 

17X. *G1 « , 6X, ' G2' ,/) 

55 FORMAT! //,22X,'K', 5X,'EX', 7X,'EY'» 4X,'XTDD0T‘, 3X, 

I'YTDDOT', 6X, 'XTDl', 6X, 'YTDl',/) 

56 FORMAT! *1', //////, 34X, 'EXTENDED KALMAN FILTER 

1* PARAMETERS' ,//) 

102 FORMAT! '1', //////, 25X, 'THE EXTENDED KALMAN FILTER' 
1* IS INITIATED WITH THE '♦/, 25X» 'FOLLOWING ELLIPSE'i 
2 • FOR CUT NUMBER', 13, ' OF TARGET', 13) 

103 FORMAT!//. 25X, 'THE ANGLE BETWEEN THE MAJOR AXIS AND' 
2' THE MERIDIAN',/, 25X, 'THROUGH THE CENTER OF THE '. 
3'ELLIPSE IS ', F7.3,' DEGREES,',//, 25X, 'THE LENGTH 0 
4'THE SEMI-MAJOR AXIS IS ',F7.3,« DEGREES.',//, 25X, 
5'THE LENGTH OF THE SEMI-MINOR AXIS IS ',F7.3,' DEGRE', 
6' ES.' ,/ / ) 

RETURN 

END 
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c 

c 

c 

c 

c 

c 

c 

c 



SUBROUTINE PREPARE 

SUBROUTINE TO ESTABLISH THE VECTOR CROSS PRODUCT 
MATRIX FOR SUBROUTINE POSIT 



subroutine PREPAR (KI ,K,SLAD,SL0D,THTD1,THTD,TLAD, 
ITLOD) 

C 

DIMENSION SLAD( 1), SLOD( 1),ACLAT(2) ,ACLON(2) ,THD(2) 
C 

DATA PIRAD/571^29578/ 

THT1=THTD1 

THT=THTD 

C 

C DETERMINE DIRECTION OF TRACK 
C 

DELLAD=SLAD( K) -SLAD(KI) 

DELLON = SLCD(K) -SLOD(KI) 

IF(DELLAD.EO.O.O.AND.DELLON.EO.O.O) GO TO 37 
TRACK = 90.-ATAN2{ DE LLADfDELLON)^ PI RAD 
IF (TRACK.lt .0.0 ) TRACK = TRACK + 360. 

IF(THT. LT. TRACK. AND. THTl .GE. TRACK) GO TO 37 
IF(THT1.LT. TRACK. AND. THT.GE. TRACK) GO TO 37 
C 

C DETERMINE IF TARGET IS LEFT OR RIGHT OF TRACK 
C 



M=1 
N = 2 

IF(TRACK.LE.iaO) GO TO 38 

IF(THT1 .LT. TRACK. AND. THTl. GE. (TRACK-180. ) ) GO TO 40 
GO TO 39 

38 IF(THT1. GT. TRACK .AND. THTl. LE. (TRACK+180. ) ) GO TO 39 

GO TO 40 



C 

C TARGET IS TO RIGHT OF TRACK 
C 

39 IF( THT1.GT.270.AND. THT. LT.90. ) THT=THT+360. 

IF(THT.GT.270.AND.THT1 .LT.90. ) THTl=THTl+360. 

IF(THT1 .GT.THT ) GO TO 37 

M=2 

N=1 



GO TO 41 
C 

C TARGET IS TO LEFT OF TRACK 
C 

40 IF(THT1. GT. 270. AND. THT. LT.90, ) THT=THT+360. 
IF(THT. GT.270.AND.THT1.lt. 90.) THTl=THTl+360. 
IF(THT. GT.THTl ) GO TO 37 

41 ACLAT (M-) = SLAD( KI ) 

ACLAT (N)=SLAD( K ) 

ACLON( M) =SLGD( KI ) 

ACLONI N ) = SLOD( K ) 

THD( M) =THT1 

THD( N)=THT 

CALL POSIT( ACL AT, ACLON.THD, TLAD.TLOD) 

RETURN 



C 

C BEARINGS DO NOT CROSS SO NO SOLUTION IS COMPUTED 
C 



37 TLAD=0.0 
TLOD=0 .0 
RETURN 
C 

END 
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SUBROUTINE POSIT (SLA, SLO, THETA, TLA, TLO) 

SUBROUTINE TO COMPUTE TARGET POSITION COORDINATES 
USING VECTOR METHODS 

DESCRIPTION OF CALLING ARGUMENTS 

SLA - AIRCRAFT LATITUDE 

SLA - AIRCRAFT LONGITUDE 

THETA - BEARING ANG LES-OF-ARRI VAL 
TLA - TARGET LATITUDE 

TLO - TARGET LONGITUDE 



SUBROUTINE POSIT (SLA, SLO, THETA, TLA, TLO) 

DIMENSION A(2),B(2),C(2),SLA(2),SL0(2),THETA(2) 

DATA PIRAD/ 57. 29578/ 

DO 1 1=1,2 
PH=SLA( I )/PIRAD 
TH=SLO( I )/PIRAD 
OB=THETA(I )/PI RAD 
ST=SIN( TH) 

CT=COS (TH) 

SP=S IN( PH) 

CP=COS( PH) 

CO=COS (OB) 

SO=SIN(OB) 

COMPUTE NORMAL TD BEARING PLANE 

DX=-SP^ CO-SC T-ST* SO 
DY=SO^:CT--SP* CD'i ST 
DZ=CP^-CO 

COMPUTE BEARING VECTORS 

X1=CP^CT 

Y1 = CP^-ST 

AA=Y1*DZ-SP:-DY 

BB = SP^sDX-Xl- DZ 

CC = X1H DY-Yl- DX 

D = SORT( AA*-:'^2+BB*“>2+CC*:S2 ) 

A(I)=AA/D 
B( I )=BB/D 
C(I)=CC/D 
1 . CONTINUE 

COMPUTE TARGET POSITION VECTOR IN (X,Y,Z) COORDINATES 

X1 = B(1 )f'C(2 )-C ( 1 )*B(2) 

X2=C(l)f-A(2)-A(l)'= C(2) 

X3=A( 1 )r5-B( 2)-B ( 1 A( 2) 

D=SORT ( Xl*--'2+X2«* 2+X3:>::)'2 ) 

X1=X1/D 

X2=X2/D 

X3=X3/D 

COMPUTE TARGET POSITION VECTOR IN (0,0) COORDINATES 
TL0=ATAN2( X2,X1)^'PI RAD 

TLA=ATAN2( X3,S ORT ( X 2+X2*rS2 )) - PIRAD 

RETURN 

END 
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POI NTS 

'ME TO LOCATE THE INTERSECTION OF THE CONES OF 
SOCIATED WITH EACH OF BEARING AND DESCRIBED BY 
rI&NCE MATRICES OF THE ANGLE FILTER AND THE 
G FILTER 



i\iE POINTS! I,J,SIGMA,RCUT,D11,HDGD, JSET,P11, 
p,THTDl,THTD,PTLAT,PTLON, JDIM,-^ ) 

J ACLAT( 2) »ACL0N(2) » DIU 1) ,HDGD( 1) , JSET( JDIM, 
(l.PTLAT(4, JDIM, 1) ,PTLON(4, JDIM, 1 ) , SLAD( 1) , 
|[HD(2) »THTD1( 1) ,THTD(1) 

HD/57. 29578/ 

i,J) 

bi(K) 

;;k) 

I.GE.B.^RCUT) GO TO 5 
!(ABS(D11 (K) ) ):i«SIGMA 
ni(K) ) SIGMA 
102 ) 

lion K,THT»P11 (K),P1,THT1,D11(K) ,D1 

luRE THAT THE TWO BEARING LINES DO NOT 
I THE SAME POINT 

I.l) 

LAD(K) -SLAD(KI) 

.0D(K) -SLODCK.n 

h.EO.O.O.AND.DELLON. EQ.0,0) GO TO 6 

SUBSCRIPTS SUCH THAT PTLAT(l), PTLON(l) IS 
HE FLIGHT PATH THAN PTL AT ( 2 ) t PTLON ( 2) . 



i.E.HDGD(K) j GO TO 1 



=SLAD( KI ) 
=SLOD(KI ) 
]=SLAD(K) 
tSLODI K) 



.LE.L. ) GO TO 4 



' EDGES OF THE ERROR ELL I 
i GREATER THAN 1 , REDUCE 
SECTION POINT. 



PSES DO NOT CROSSt SO 
IT TO 1 AND COMPUTE 



fl04) 

3F INTERSECTION OF THTDL - D1 WITH THTD + PI 



fHTl-Dl 

■HT+Pl 

l.LE.THD(2) .AND.M.EO.l) GO TO 2 
l.LE.THD(l) .AND.M.E0.2) GO TO 2 
IT!ACLAT,ACL0N,THD,TLAT ,TL0N) 
l.J)=TLAT 
l.J)=TLON 

OF INTERSECTION OF THTDl + D1 WITH THTD - PI 
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THO( 1) =THT1+D1 
THO( 2)=THT-P1 

IF(TH0(1 ) .LE.TH0(2 ) .AND.M.EO.l) GO TO 
IF(THD( 2).LE.THD(1) .AN0.M.E0.2) GO TO 
CALL POS IT ( ACL AT . ACLON , THO . TLAT t TLON ) 
PTLAT(N.I« J)=TLAT 
PTLON( N.I , J)=TLON 



FIND POINT OF INTERSECTION OF THTOl - D1 WITH THTO - PI 

THD( 1)=THT1-D1 
THD(2)=THT-P1 

CALL POSIT( ACLAT,ACLON,THD,TLATtTLON) 

PTLATO, I, J)=TLAT 
PTL0N(3«I«J)=TL0N 

FIND POINT OF INTERSECTION OF THTDl + 01 WITH THTD ♦ PI 

THD( 1) =THT1+D1 
THD(2)=THT+P1 

CALL POSIT( ACL AT .ACLON, THDfTLATtTLON) 

PTLAT( 4, I, J)=TLAT 
PTL0N(4, I, J)=TLON 
RETURN 



WRITE(6. 105) 
RETURN 1 
WRITE(6. 103) 
RETURN 1 
WRITE! 6.106) 
RETURN 1 



P11(K).I. J 
I 



101 FORMAT! I 5, 6E 12 

102 FORMAT !'1». /, 
18X. ' PI* . 6X. 

103 FORMAT!//. 5X. 
1* A SOLUTION 

104 FORMAT! /. » 

105 FORMAT!//, 5X. 
1* CROSS. SO NO 

106 FORMAT!//. 5X. 



.4) 

4X. 'K*. 

• THTD1!K) 



5X, »THTO!K)', 
,6X. •011!K)'. 
•THE ERROR COVARIANCE IS 
WOULD BE MEANINGLESS. 



6X, 

8X, 

• . 



•P11!K) • , 

• 01 ', /) 

F12.4, • -• 



SIGMA = 1. • ./) 



J=' ,13,/ 



I'CORRELATED WITH TRAGET 
2*UTI0N IS POSSIBLE',//) 
RETURN 
END 



•THE TWO OUTSIDE BEARINGS 
SOLUTION IS POSSIBLE. ♦.// ) 
♦THE BEGINNING AND END OE 



DO NOT 



12 , 



COINCIDE 



THE 

SO 



TRACK • 
NO SOL' 
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c 

c 

C SUBROUTINE PIC 

C 

C SUBROUTINE TO PLOT THE DF CUTSt ERROR ELLIPSES 

C COMPUTED FROM THE ANGLE FILTER AND THE ERROR ELLIPSES 

C DESCRIBED BY THE COVARIANCE MATRIX OF THE EXTENDED 

C KALMAN FILTER 

C 

C MODES 

C 

C IFLAG=1 PLOTS THE DF CUTS CORRELATED TO TARGET I 

C IFLAG=2 PLOTS THE ERROR ELLIPSE DESCRIBED BY THE Pll 

C AND Dll TERMS FROM THE ANGLE FILTERING ROUTINE 

C ASSOCIATED WITH CUT J OF TARGET I 

C 

C THIS SUBROUTINE FIRST DETERMINES THE MAJOR DIRECTION 

C OF THE PLOT, PLOTS IT THE MAJOR DIRECTION OF THE PLOT 

C USING A MERCATOR PROJECTION 

C 

C 



c 



c 



c 

c 



1 



9 



10 

41 



SUBROUTINE P IC ( I FLAG, I , J J ,N ST, JSE T , SLAD , S LOD , T LAD , 

1 TLOD, THETA, THTD, THTDl, P11,D11,HDGD,RCUT,J DIM, PTLAT, 
2PTL0N,SIGMA ,P12,P22,XTD1,YTD1) 

DI MENS I ON ACL AT ( 100 ) , ACLON {100),A(4),B(4),D11{1), 
IFLADI 100) ,FLOD{ 100) ,HDGD ( 1 ) , I T 1 { 12 ) , IT2 ( 12 ) , IT3 { 12 ) , 
2IT4(13), JSETUDIM, 1 ) , NST { 1 ) , NUMB { 25 ) ,P TLA T( 4 , JD I M , 1 ) , 
3PTL0NI4, J0IM,1) , Pll (1) ,SLAD( 1 ) , SLOD{ 1 ),THETA{ 1), 
4TLAD( 1) ,TL0D(1) ,THTD(1) , THTDl (1) , XX { 101 ) , X Z ( 1 01 ) , 

5YY( 101) , P12( 1) , P22( 1), XTDK 1) , YTDK 1) ,IT5{ 13) 

DATA ITl/'PLOT OF DF CUTS AND A/C NAVIGATION DATA •/ 
DATA IT2/' EDWARD H. MILLS '/ 

DATA IT3/' NTAR = '/ 

DATA IT4/'PL0T',' OF ','ERRO','R CO ' , ' VARI ' , ' ANCE • , 
I'S OF',' SMO', 'OTHE', 'D BE ' , ' AR IN ' , ' G LI','NES '/ 

DATA IT5/'PL0T',' OF ','ERRO','R CO' , ' V AR I ' , ' ANCE' , 
I'S OF',' EXT', *ENDE','D KA','LMAN',' FIL','TER '/ 

DATA NUMB/ '1','2','3', '4', '5', '6', '7', *8', '9', '10', 

1 ' 11' , ' 12' , ' 13' , ' 14' , ' 15* , • 16' , ' 17' ,' 18' , *19' , '20' , 

2 '21', *22', '23' , '24', '25'/ 



DATA PIRAD/57. 29578/ 



NSTA=NST ( I ) 

IF{ IFLAG .EO. 1) JJ=NSTA 
DO 1 J=1,NSTA 
K=JSET( I , J) 

ACLATI J)=SLAD( K) 

ACLONI J)=SLOD(K) 
IF(IFLAG.EQ.2) GO TO 9 
IF{ IFLAG.EO. 3) GO TO 41 
A(1 )=TLAD( I ) 

B( 1)=TL0D( I ) 

ALATS=SMALL2(ACLAT,NSTA,A, 1) 
ALATH=HUGE2 ( ACLAT, NST A, A, 1 ) 
AL0NS=SMALL2(ACL0N,NSTA,B, 1) 
AL0NH=HUGE2(ACL0N, NSTA, B, 1) 



GO TO 12 

CALL^POINTsfl, J J, SI GMA?RCUT , Dl 1 , HDGD , J SET, Pll , SLAD, 
LSLOD, THTDl, THTD, PTLAT , PTLON, JD IM, £1000) 

DO 10 N=l,4 
XX(N)=PTLON(N, I, JJ ) 

YY(N)=PTLAT(N, I , JJ) 



GO TO 42 

CAlPeLIPS 7(P1UK) ,P12(K) ,P22(K) ,XTDUK) ,YTD1(K),XX 
lYY) 



f 
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42 



N = 101 

AL0NS=SMALL2(ACL0N,NSTA,XX,N) 

AL0NH=HUGE2( ACLCN,NSTA,XX,N) 

ALATS=SMALL2 ( ACLAT, NST A»YY, N) 
ALATH=HUGE2(ACLAT,NSTA,YY,N) 

ADAD=AIRCRAFT POSITION LATITUDE VARIATION IN DEGREES 
ADOD=AIRCRAFT POSITION LONGITUDE VARIATION IN DEGREES 

12 ACAD=ABS (ALATH-ALATS ) 

ADOD=ABS( ALONH-ALONS) 

ASLAR=( (ALATH+ALATS)/2. )/PIRAD 
CSLA=COS(ASLAR) 

ADAD2=. 7 5>’':ADAD 
IF(AD0D.GT.ADAD2) GO TO 21 

} 

ADAD IS GREATER THAN ADOD 

PROGRAM TO SCALE DATA FOR NORTH LATITUDE AND WEST 
LONGITUDE ONLY 

COMPUTE X AND Y SCALE INCREMENT VALUES DX AND DY 
DX=1 . 

IF(ADAD.GT.8) 0X=ADAD/8. 

IF( AD0D.GT.6) DX=AD0D/6. 

IF(AD0D.LE.3 .AND . AD AD . L E . 4) DX= . 5 
IF ( ADOD. LE. 1.5. AND. ADAD. LE. 2 ) DY=.25 
DY=DX 

COMPUTE X AND Y AXIS INITIAL VALUES XMIN AND YMIN 
LONGITUDE IS WEST(-) IN DEGREES 
ABSC=0,0 

MIN=ALONS-{DX+.5) 

XMIN=MIN . 

LATITUDE IS NORTH(+) IN DEGREES 
0RD=90.0 

MIN=ALATS-(DY<-.5 ) 

Y(MIN=MIN 

DRAW AXIS 



X0RIG=0.0 

Y0RIG=0 .0 

CDIV=1 

SDIV=CSLA 

LA=1 

LB=2 

LC=-7 

IT3(7)=NUMB( I) 

CALL PLOTS 

CALL PL0T(-3., 0, ,-3) 

CALL PL0T(1..0 .,-3 ) ' 

CALL AXI S( XORIG.YORIG, ' DEGREES LONG I TUDE* » -17 , 6 . 0 , 
lABSC, XMIN.DX.CDIV, SDIV) 

CALL AXIS(XORIG,YORIG, 'DEGREES LAT ITUDE • 16, 8. , ORD, 
lYMIN.DY.CDI V.SDI V) 

CALL SYMBOL (0.0, 14.0,0.21, IT 2, 0.0, 40) 

CALL SYMB0L(0.0 , 13. 5, 0.21, IT 3, 0.0, 40) 

SCALE DATA 



DY=DX;-CSLA 
DO 2 N=1,NSTA 
XX( N)=( ACLCN(N)-XMIN)/DX 
2 YY(N)=(ACLAT(N)-YMIN) /DY 

DRAW NAV TRACK 
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CALL L INE( XX,YY,NSTA,LA,LB ) 

C 

IF( IFLAG.E0.2) GO TO 5 

IF( IFLAG.E0.3) GO TO 43 

CALL SYMBOL (0.0 » 14. 5« 0.21, IT 1,0. 0,40) 

PLOT DF CUTS TO FORM THEORETICAL EMMITTER LOCATION 

DO 4 J=1.NSTA 
DT=0.0 
K=JSET( I . J) 

CTH=C0S( THETA( K) ) 

STH=SIN(THETA(K) ) 

DO 3 L=1.100 
LL = L 

FLAD(L) = YY( J ) + DT'4CTH 
FLOD(L) =XX( J1 + DT;!'STH 

IF(FLAD(L) .GT. 8 .OR . F LAD ( L ) . LT . 0 ) GO TO 13 
IF(FLOD(U .GT.6 . OR. FLO D( L ) . L T . 0 ) GO TO 13 
DT = .07*; L 

3 CONTINUE 

13 CALL LINE( FLCD, FLAD,LL,LA,LC) 

4 CONTINUE 

SUBROUTINE TO PLOT SMOOTHED INITIAL BEARING LINE AND 
KALMAN FILTERED FINAL BEARING LINE 

SMOOTHED INITIAL BEARING LINE (THTDl) 

KI=JSET( I. 1) 

KF=JSET ( I.NSTA ) 

THT1=THTD1( KF) /PIRAD 
FX = XX( l)+8.:’ SIN(THTl) 

FY=YY( 1 )+8 .“^'COS (THTl) 

SX=XX( 1 ) 

SY=YY( 1 ) 

CALL PL0T(SX,SY,3) 

CALL PL0T( FX, FY, 2) 

KALMAN FILTERED FINAL BEARING LINE (THTD) 

THTF=THTD(KF)/ PIRAD 
FY=YY(NSTA)+8. <COS(THTF) 

FX=XX(NSTA ) + 8. ^SIN( THTF) 

SX=XX(NSTA) 

SY=YY( NSTA ) 

CALL PLOT( SX, SY, 3) 

CALL PLOT( FX, FY,2) 

GO TO 8 

PLOT THE ELLIPSE FORMED BY THE Pll TERMS OF THE 
ERROR COVARIANCE MATRICES. 

5 CALL SYMBOL! 0. 0, 15. 0, 0. 21, IT4,0.0,52) 

FLOOT=JJ 

CALL NUMBER(5.25, 7 . , . 14 , FLOOT , 90 . , -1 ) 

KI=JSET( I. 1) 

K=JSET( I, JJ ) 

DO 11 N=l,4 

XX(N) = PTLON(N, I , JJ) 

11 YY (N) =PTLAT (N, I, JJ ) 

CALL ELI PS6( KI . K , S L AD , S LOD , THT D1 ( K ) , T HT D ( K ) , D 1 1 { K ) , 
LPIL(K) . XX, YY.AL,B1, ALPHA1,TLAD( I ) ,TLOD( I ) ) 

20 DO 6 K=1.L0L 

XX( K) ={ XX( K)-XMI N) /DX 

6 YY (K )= ( YY( K )-YMIN ) /DY 
CALL LINE(XX,YY, 101,1, 1) 

PLOT THE FILTERED FIRST AND CURRENT FINAL CUTS. 
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K=JSET( I ,JJ) 

THT1=THTD1(K)/PIRAD 
S X = ( AC L AT ( 1 ) -X M I N ) / DX 
SY = ( ACLON( D-YMI N) /DY 
FX=SX + 8.:;C0S(THT1) 

FY=SY+8.>’SIN(THT1) 

CALL PLOT( SX.SY, 3) 

CALL PLOKFX. FY, 2) 

THT=THTD(K) /PI RAD 
SX=(ACLAT( J)-XMIN) /DX 
SY = ( ACLC N( J )-YMIN)/DY 
FX=SX+8.>: COS(THT) 

FY=SY+8.^^ SIN(THT) 

CALL PL0T(SX,SY,3) 

CALL PLOT( FX,FY,2) 

C 

GO TO 8 

PLOT THE ellipse FORMED BY THE ERROR COVARIANCE TERMS 
OF THE EXTENDED KALMAN FILTER. 

43 CALL SYMBOLIC. 0. 15.0,0.21. IT5, 0.0, 52) 

FLOOT=JJ 

CALL NUMBER(5.25, 7. , . 14, FLOOT , 90 . ,-l ) 

K=JSET ( I. JJ ) 

CALL ELIPS7(P11(K) ,P12 (K),P22(K),XTD1(K),YTD1(K),XX, 
lYY) 

DO 44 K=l. 101 
XX(K)=(XX(K)-XMIN)/DX 

44 YY (K)= ( YY(K )-YMIN ) /DY 
CALL LINEIXX.YY, 101,1, 1) 

8 CALL PL0T(-3. , 18. ,-3) 

CALL PL0T(1.75,0.,-3) 

CALL PLOTE 
RETURN 

21 DY=1. 

ADOD IS GREATER THAN ADAD 

IF( AD0D.GE.8) DY=AD0D/8. 

IF(ADAD-GT.o) DY=ADAD/6. 

IF(AD0D.LE.4.AND.ACAD.LE.3.) DY=.5 
IF( AD0D.LE.2.AND.ADAD.LE.1.5) DY=.25 
LONGITUDE IS WEST(-) IN DEGREES 
DX=DY 
ABSC=90.0 
MIN=ALONS-(DY•^ .5 ) 

YMIN=MIN 

IF( DY.LT .( .5) ) YMIN=ALONS-DY 
LATITUDE IS NORTH( + ) IN DEGREES 
ORD=0. 0 
MIN=ALATS-.5 
XMIN=MIN 

IF(ABS( XMIN-ALATS) .GT. .9) XMIN = XMI N-i-1 . 

IF ( DX .LT . ( .5 ) ) XMIN=ALATS 

XMAX=XMI N+5. ’DX 

DX=-DX 

DRAW AXIS 

X0RIG=0.0 
YQRIG=0.0 
CDI V=CSLA 
SDIV=1 . 

LA = 1 
LB = 2 
LC=-7 

IT3(7) =NUMB( I ) 

CALL PLOTS 

CALL PL0T(-3., 0 .,-3 ) 
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CALL PL0T(2. ,0 . ,-3 ) 

CALL AXIS( XORIG.YORIG, 'DEGREES LATI TUDE ' ,-16 ,6. 0» ORD, 
1XMAX,DX,CDIV,SDIV) 

CALL AXIS( X0RIG,Y0RIG, 'DEGREES LONG ITUDE ’ , -1 7 , 8 .0 , 
lABSC.YMIN, DYtCDIV, SDIV) 

CALL PLOT(XORIG,YORIG,3) 

CALL PLOT( 0.0, YORIG,2) 

CALL PLOT (0.0, 0.0, 2) 

CALL SYMB0L(0.0, 14.0,0.21 , I T2, 0.0, 40) 

CALL SYMBOL (0. 0, 13. 5, 0. 2 1 , I T3 , 0 . 0 , 40 ) 

CALL PLOT(XORIG,0.,-3) 

SCALE DATA 

DX=DX5-CSLA 

DO 22 N=1,NSTA 

XX(N)= (ACLAT(N)-XMIN)/DX 

22 YY(N) =( ACLON(N)-YMI N) /DY 

CRAW NAV TRACK 

CALL LINE(XX,YY,NSTA,LA,LB) 

IF( IFLAG.E0.2) GO TO 27 
IF( IFLAG.E0.3) GO TO 45 
' ORIGX = XnRI G-,7 5 
ORIGY=YORIG+.3 

CALL SYMBOL (-OR IGX, OR I GY, . 14 , I T 1 , 0 . , 40 ) 

FLOOT=I 

CALL NUMBER(-. 75,7. ,. 14,FLOOT ,90. ,-l) 

PLOT OF CUTS TO FORM THEORETICAL EMMITTER LOCATION 

DO 26 J=1,NSTA 
DT=0.0 
K=JSET( I , J ) 

CTH=COS (THETA( K ) ) 

STH=SIN( THETA( K) ) 

DO 23 L=l, 100 
LL = L 

FLAD(L ) =XX( J)-DT5-CTH 
FLOD(L )=YY (J )+DT4STH 

IF(FLAD( L) .GT.O.OR. FLAD(L) .LT.-6) GO TO 24 
IF( FLODC L) .GT. 8. OR. F LOD ( L ) . LT . 0 ) GO TO 24 
DT = .07^L 

23 CONTINUE 

24 CALL LINE(FLAD ,FLOD,LL,LA,LC) 

26 CONTINUE 

SUBROUTINE TO PLOT SMOOTHED INITIAL BEARING LINE AND 
KALMAN FILTERED FINAL BEARING LINE 

SMOOTHED INITIAL BEARING LINE (THTDl) 

KF=JSET( I ,NSTA ) 

THT1=THTD1( KF) /PIRAD 
FX=XX( 1 )-8 COS(THTl) 

FY=YY( 1)+8.4SIN(THT1) 

SX=XX( 1) 

SY=YY(1 ) 

CALL PLOT(SX,SY,3) 

CALL PLOT(FX, FY, 2) 

WRITE(6,101) SX,SY 

KALMAN FILTERED FINAL BEARING LINE (THTD) 

THTF=THTD( KF)/PIRAD 

FX = XX(NSTA)-8.^'COS(THTF) 

FY=YY( NSTA )+S . S I N ( THT F) 

SX=XX( NSTA ) 

SY=YY(NSTA) 

CALL PLOT(SX,SY,3) 
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CALL PLOT( FX.FY, 2) 

WRITE(6,10L) SX,SY 
GO TO 30 

PLOT THE ELLIPSE FORMED BY THE Pll TERMS OF THE 
ERROR COVARIANCE MATRICES. 

27 0RIGY=Y0RIG+.3 

CALL SYMB0L(-X0RIG,0RI GYt 0. 14 , I T4 ,0 . , 52 ) 

FL00T=JJ 

CALL NUMBER(-.75,7 .»0. L4»FL00T,90.,-1) 

KI=JSET( 1,1) 

K=JSET( I ,JJ ) 

DO 40 N=l,4 
XX(N)=PTLON(N, I , JJ) 

40 YY(N) = PTLAT(N, I, JJ) 

CALL ELIPS6(KI , K ,S L AD , S LOD , T HT D 1 ( K ) , THTD ( K ),D11(K), 
1P11(K),XX,YY,A1,B1 , ALPHA 1,TL AD ( I) ,TLOD( I ) ) 
WRITF(6,101)(XX(J),YY(J),J=1,10) 

WRITE(6,101) XMIN,YMIN 
DO 29 J = 1,101 
XZ(J)=(YY( J)-XMIN)/DX 

29 YY( J) = (XX( J)-YMIN) /DY 
WRITE(6, 101) (XZ( J) ,YY( J) ,J=1,10) 

CALL LINF(XZ,YY, 101,1, 1) 

PLOT THE FILTERED FIRST AND CURRENT FINAL CUTS. 

THT1=THTD1 (K)/PI RAD 
SX=(ACLAT( 1)-XMIN)/DX 
SY=(ACLON( 1 )-YMIN)/DY 
FX=SX-7.*C0S(THT1 ) 

FY = SY+7.:? SIN(THT 1) 

CALL PL0T(SX,SY,3) 

CALL PLOT(FX,F Y,2) 

THT=THTD(K )/PI RAD 
WRITE(6,100) K,THT 
SX=(ACLAT( JJ)-XMIN) /DX 
SY=(ACLCN( JJ )-YMIN J/DY 
FX=SX-7.tC0S(THT) 

FY=SY+7.4SIN(THT) 

CALL PL0T(SX,SY,3) 

CALL PLDT( FX,F Y,2) 

GO TO 30 

PLOT THE ELLIPSE FORMED BY THE ERROR COVARIANCE TERMS 
OF THE EXTENDED KALMAN FILTER. 

45 0RIGY=Y0RIG+.3 

CALL SYM30L(-X0RIG,0RIGY,0. 14, I T5 , 0, , 52) 

FLOOT=JJ 

CALL NUMBER!-. 75, 7. ,. 14 , F LOOT , 90 . , -1 ) 

K=JSET{ I ,J J ) 

CALL ELI PS7(P11(K) ,P12 (K),P22(K),XTD1(K ) , YTOl ( K ) , XX, 
lYY ) 

DO 46 J= 1, 101 

XZ( J) = ( YY( J) -XMI N) /DX 

46 YY(J)=( XX( J)-YMIM) /DY 
CALL LINE(XZ,YY, 101, 1, 1 ) 

MARK THE KNOWN POSITION OF THE TARGET 

30 IF( I .GT.2) GO TO 47 
IF(I.E0.2) GO TO 36 
ATLAD=33 .24055 
ATL0N=-117.4169 

GO TO 37 

36 ATLAD=32. 78222 
ATL0N=-117.2244 

37 SX1= ( ATLAD-XM IN ) /DX 
SY1=( ATLON-YMIN) /DY 
SX=SX1-1. 
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FX = SXl + l . 

SY=SY1-1 . 

FY=SY1+1. 

CALL PL0T(SX,SY1,3) 
CALL PLOKFXtSYl ,2 ) 
CALL PLOT( SXl, SY«3) 
CALL PLOKSXl, FY«2 ) 

47 CALL PLOT(-12. .18. ,-3 ) 
CALL PL0T(1.75,0..-3) 
CALL PLOTE 

1.00 FORMAT! I5.2F12.6) 

101 F0RMAT(2F12.6./) 

102 FORMAT! ' 1* . 13) 

105 FORMAT! 2F12.3.3I 5) 

1000 RETURN 
END 



SUBROUTINE AXIS 

SUBROUTINE TO COMPUTE. DRAW AND LABEL THE AXES FOR A 
MERCATOR PROJECTION IN THE NORTH WEST HEMISPHERE 



SUBROUTINE AXIS !X B , YB . BCD. NC. S I ZE. THET A . YM IN , DY . CD I V , 
ISDIV) 

DIMENSION BCD! 1 ) 

ZING = 1.0 
IF!NC) 1, 2. 2 

1 ZING = -1.0 

2 NAC = IABS!NC) 

TH=THETA:-. 0174533 
CTH=COS !TH)/CDIV 
STH=SIN!TH)/SDIV 
N = SIZE+0.50 

IF!THETA.E0.90.AND.CDIV.E0.1 ) N=SIZE-SDIV 

IF! THETA. EO.O. AND. SDIV.EO. 1) N = SIZE^^CDIV 

TN=N 

X=XB 

Y=YB 

XA = X - 0.1 I' ZING STH 
YA = Y + 0.1 ^ ZING *•' CTH 
CALL PLOT !XA.YA.3) 

DO 20 I = 1.N 

CALL PLOT !XB.YB.2) 

XC=XB + CTH 
YC=YB+STH 

CALL PLOT ! XC. YC.2 ) 

XA=XA-j-CTH 

YA=YA + STH 

CALL PLOT! XA.YA.2) 

XB=XC 
20 Y8=YC 

YA=Y-0. 250 

IF!ABS!YMIN) .GE. 100. )YA=Y-.375 

IF!A3S!YMIN) .G F . 10 0 . AN 0 . YM I N .LT . 0 . 0 ) YA = Y-.50 
IF! THETA. EO. 90. 0) GO TO 22 
IF!THETA.EO.O.O)GG TO 24 
22 XA=X + 0.250 
GO TO 25 

24 XA=X-.250 

I F!ABS! YMI N) .G E . 1 00 . ) X A=X- .3 75 

IF!ABS! YMIN) .G E . 100 . A ND. YM I N . LT . 0. 0 ) XA=X-.50 

25 WRITE!6,61 )XA. YA 
ABSV=YMIN 

DO 30 1=1. N 

CALL NUMBER!XA.YA.O .14. ABSV.THETA. 2) 

ABSV=ABSV+DY 
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XA=XA+CTH 
YA=YA+STH 
30 CONTINUE 
TNC=NAC+7 
CTH=CTHvC01V 

sth=sth; SOI V 

XA=X + (SIZE /2.0-.06 •’^TNC)*CTH - (-.07 + ZING'>.42)^' STH 
YA=Y+(SIZE /2.0-.06 ^MNC J^-STH + (-.07 + ZING-'‘.42)^ CTH 
CALL SYMBOL ( XA ,YA, 0. 14 , BCD , THET A , N AC ) 

WRITE(6.62 )XB. YB 

60 F0RMAT(*0 ABSV = » , FIO .5 ) 

61 FORMAK'O XA=',F10.5,' YA=',F10.5) 

62 FORMAT (/,3X, *XB=' , FIO .5, 2X, ' YB= • , F10.5, / ) 

50 RETURN 

END 



FUNCTION SMALL2( A,NSTA,B,N) 
DIMENSION A( 50 ) ,B( 50) 
SMALL2=A(1 ) 

DO 1 I=2,NSTA 

IF(SMALL2.LE.A ( I ) ) GO TO 1 
SMALL2=A(I ) 

1 CONTINUE 
DO 2 I=1.N 

IF(SMALL2.LE.B( I ) ) GO TO 2 
SMALL2=B( I ) 

2 CONTINUE 
RETURN 
END 



FUNCTION HUGE2 ( A,NSTA, BtN) 
DIMENSION A( 50) ,B( 50) 

HUGE 2= A ( 1) 

DO 1 I=2.NSTA 
I F( HUGE2.GE .A( I ) ) GO TO 1 
HUGE2 = A( I ) 

1 CONTINUE 
DO 2 I = 1,N 

IF(HUGE2.GE.B( I ) ) GO TO 2 
HUGE2=B(I) 

2 CONTINUE 
RETURN 
END 
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SUBROUTINE ELI PS6 

SUBROUTINE TO DESCRIBE AN ELLIPSE TO FIT THE FOUR 
POINTS COMPUTED IN SUBROUTINE POINTS 



SUBROUTINE ELI PS6(KI , KC , SLAD , S LOD t THT Dl t THTD, D1 1 , PI 1 , 
IX3.Y3» A1,BI»ALPHA1, TLADtTLOD) 

DIMENSION SLAD( 1),SLQD(1) » X ( 1 01 ) , X3 ( 1 01 ) , Y ( 1 01 ) , 
1Y3(101 ) » Z(4) 

DATA PIRAD/57. 29578/ 

CALL PREPAR (K I » KC » S LAD , SLOD, T HTD 1 , THTD f TL AD, TLOD ) 

TLAD. TLOD IS THE CURRENT ESTIMATE OF THE TARGET 
POS ITION. 

X3.Y3 ARE THE LOCATIONS OF THE INTERSECTIONS OF THE 
EDGES OF THE TWO ERROR CONES. 

DELX=X3( 1)-X3( 2) 

DELY=Y3 ( 1 )-Y3( 2 ) 

ALPHA 1 =A TAN2 (DE LX, DELY) 

ALPHA2 = ALPHA 1-1. 57 37963 
ALPHAD = ALPHA1^ PIRAD 

ALPHAD IS THE ANGLE OF ROTATION OF THE ELLIPSE 

DELX=TL0D-X3(2 ) 

DELY=TLAD-Y3(2 ) 

A 1 =S ORT ( DE LX4; (• 2 + DE L 2 ) 

A1 IS THE SEMI-MAJOR AXIS 

DO 4 K=3,4 
DELX=TL0D-X3(K ) 

DELY=TLAD-Y3(K) 

BETA = ATAN2( DEL X, DELY) 

GAMMA=ALPHA2-BETA 
4 Z( K) =S0RT(DELXC-r2+DELY*^2 )*COS(GAMMA) 

B1=(ABS(Z(3) )+ABS(Z(4) ) )/2.0 

B1 IS THE SEMI-MINOR AXIS 

WRITE(6.103) ALPHAD, A1,B1 

EPS=Al/25. 

Y(1)=-A1 
Y( 101) =-Al 
AA = A1*»' 2 
BB=Blt ^:2 
DO 1 K = 2,51 
KK=K-1 

Y( K) =Y( KK) +EPS 

1 Y( 102-K) =Y( K) 

DO 2 K=l,51 

CC = ABS(BB*(l.-(Y(K)i^-;‘2 )/AA) ) 

X(K)=SORT(CC) 

2 X(102-K)=-X(K) 

ROTATE THE ELLIPSE BY ALPHAD AND TRANSLATE ITS CENTER TO 
TLOD, TLAD. 

CA=COS( ALPHAl ) 

SA=SIN ( ALPHAl ) 

DO 3 K=l,101 
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C 

101 . 

103 



X3(K) = X(K)-: CA<-Y(K) - SA+TLOD 
Y31K)=-X (K SA+Y (K )^‘CA+TLAD 

WRITE(6, 101) X3 (1 ) , Y3(l ) ,X3 (50) ,Y3 (50 ) ,X3 ( 25) ,Y3{ 25) , 
1X3(75) ♦ Y3( 75) 

F0RMAT(4F12.2) 

FnRMAK //. 5X, ' THE ANGLE BETWEEN THE MAJOR AXIS AND 
2'THE MERIDIAN* ,/«5X,'THR0UGH THE CENTER OF THE '♦ 
3'FLLIPSE IS •♦F7.3,' DEG RE E S . ' t // t 5X , • T HE LENGTH OF 
4'THE SEMI-MAJOR AXIS IS ',F7.3»' DEGREE S. •»//, 5X, 

5*THE LENGTH OF THE SEMI-MINOR AXIS IS *,F7.3,' DEGRE', 
6'ES. • ,//) 

RETURN 

END 
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SUBROUTINE ELIPS7 

SUBROUTINE TO DESCRIBE THE ELLIPSE TO FIT THE ERROR 
COVARIANCE TERMS IN THE EXTENDED KALMAN FILTER 



SUBROUTINE ELI PS7 (A ,C, B.TLOD.TLAD, X3,Y3 ) 

DIMENSION X( 101 ) , Y( 101) , X3( 101) , Y3( 101) 

DATA PIRAD/57. 29578/ 

AMIB=A-B 

IF( ABS( AMI B) .LT. lE-8) GO TO 10 
ALPHAD = 90.-.5-?'ATAN2( ( 2 .*>C ) , AM I B ) ^ PIRAD 
GO TO 11 

10 ALPHAD=0.0 

11 ALPHA1 = ALPHAD/PIRAD 
CA=COS( ALPHA! ) 

SA=SIN ( ALPHAl 1 

A2 = ABS ( A:t‘SA-X--'2+2 .*C^'SA^CA+B=<-CA^^2) 

A1=S0RT( 42) 

B2 = ABS( A--: CA'- r' 2-2 C^'S A--^CA + B'i^ SA*^ 2 ) 

B1=S0RT(B2) 

ALPHAD IS THE ANGLE OF ROTATION OF THE ELLIPSE 

A1 IS THE SEMI-MAJOR AXIS 

B1 IS THE SEMI-MINOR AXIS 

WRITE(6*103) ALPHAD,A1»B1 

EPS=Al/25. 

Y( 1 ) =-Al 
Y( 101) =-Al 
BB=B2 
AA=A2 

DO 1 K=2,51 
KK=K-1 

Y(K)=Y(KK)+EPS 

1 Y( 102-K)=Y( K) 

DO 2 K=1.51 

CC=ABS(BB>:- (l.-(Y{K)^:>^2 )/AA) ) 

X(K)=SORT(CG) 

2 X (102-K)=-X(K) 

ROTATE THE ELIPSE SUCH THAT AA IS PARALLEL TO THTDl AND 
TRANSLATE TO XZERO AND YZERO. 

DO 3 K=l,101 

X3(K)=X (K):^CA+Y(K) sSA+TLOD 

3 Y3(K) =-X(K)^ SA+Y(K)-?CA+TLAD 
DO 23 K=l, 51 

23 WRITE! 6 .101 )X3 ( K ) , Y3 ( K ) , X3 ( K+50 ) ,Y3(K+50) 

C 

101 FORMAT! 4F12. 2) 

103 FORMAT !5X, 'THE ANGLE BETWEEN THE MAJOR AXIS AND THE • 
I'MERIDIAN THROUGH THE CENTER OF THE ELLIPSE IS «,F7.3, 
1' DEGREES',/, 5X, 'THE LENGTH OF THE SEMI-MAJOR AXIS • 
2'IS',F7.3,‘ DEGREES', /, 5X, 'THE LENGTH OF THE SEMI-' 
3'MINOR AXIS IS',F7.3,' DEGREES',/) 

104 FORMAT! /, 5X , ' LATT I TUDE AND LONGITUDE OF', /, 3X, 
I'THTD -t- Pll THTD -Pll THTDl - Dll THTDl + Dll', /,3X 
2'WITH THTDl WITH THTDl WITH THTD WITH THTD', /) 

RETURN 

END 
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SUBROUT INE MONACO (NUM. IX , ST D £V , STDEVN , AME AN , KFL AG , NP UN 



SUBROUTINE TO READ AIRCRAFT DATA AND ADD GAUSSIANLY 
DISTRIBUTED RANDOM NOISE 

LIST OF VARIABLES 

IX - INITIAL NUMBER FOR RANDOM NUMBER GENERATOR 

STDEV - STANDARD DEVIATION OF NOISE ADDED TO DF BEARIN 

STDEVN- STANDARD DEVIATION OF NOISE ADDED TO NAVIGATIO 

AMEAN - MEAN OF ALL NOISE 

KFLAG - COUNTER FOR REPEATED MONTE CARLO RUNS 
NRUN - NUMBER OF RUNS DESIRED FOR MONTE CARLO 

SIMULATION. MUST BE GREATER THAN OR EQUAL TO 2 
AMEANT- MEAN OF DF BEARING NOISE 
AMEANE- MEAN OF LONGITUDE NOISE 
AMEANN- MEAN DF LATITUDE NOISE 
VARIT - VARIANCE OF BEARING NOISE 
VARIE - VARIANCE OF LONGITUDE NOISE 
VARIN - VARIANCE OF LATITUDE NOISE 

PIRAD - CONVERSION FACTOR 57.29578 DEGREES PER RADIAN 



SUBROUTINE MONACO! NUM, IX, STDEV, STDE VN , AM EA N , KFL AG , NRUN 

COMMON ACL AD (100) , ACL AMD (100) .ACLARIIOO) ,ACL0D(100), 

1 ACLOMD! 100 ) , ACLOR! 100 ) , AL T { 1 00 ) ,BRNG( 100) ,BRNGD( 100) , 
2E{100),FRE0(100) , G1 ( 1 0 0 ) , G2 ( 100 ) , GAT E ( 1 00 ) , HDG( 100), 
3HDGD( 100) ,MODEN( 100 ) ,MODET{ 100),NST(100) ,P11(100) , 

4P12 (100 ) ,P22(100 ), P ITCH! 100) ,PRF{ 100),PW( 100) , 

5RQLL( 100) ,SLA( 100) ,SLAD( 100) ,SL0(100) ,SL0D{100), 

5T( 100) . TIMEN( 100 ), TIMET! 100) ,TDTD( 100) , THTD! 100) , 
6THTD1! 100) , THETA! 100) , THETAD!100 ) , TL AD! 1 00 ) , TLQD ! 100) , 
7VEL! 100) ,VELE! 100) , VELN! 100) ,XTD! 100) ,YTD! 100) , 
8D11!100),JST!100) 

DATA AMEANT.AMEANE, AMEANN, VARIT, VARI E, VARIN/0 .,0. ,0. , 
10..0..0./ 

DATA PI RAD/57. 29578/ 

IFIKFLAG.NE. 1) GO TO 3 

SUBROUTINE TO READ EMITTER TARGET AND AIRCRAFT 

NAVIGATION DATA FROM CARO DATA DECK 

DATA SEQUENCE MUST BE OF FORMAT TGT/NAV 

DO 1 1=1,100 

NUM=I-1 

READ EMITTER TARGET DATA 

READ! 5,48,END=8) TGT, TIMET!I) ,BRNGD! I),PRF! I ) , PW ! I ), 

1 FREQ! I ) 

READ AIRCRAFT NAVIGATION DATA 

READ!5,48 )HDGD! I ), ACL AMD! I ) ,ACLOMD! I ) , ALT ! I) , VELN! I ) , 
IVELE! I ) 

1 CONTINUE 

SUBROUTINE TO COMPUTE AIRCRAFT VELOCITY 

8 DO 2 1 = 1 .NUM 

VELS=VFLE! I )?■ ^?”2+ VE LN! I )«^<-2 

VEL! I )=SQRT!VELS ) 

SUBROUTINE TO CHANGE ANGLES FROM DEGREES TO RADIANS 
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HOG( I ) =HOGD( I )/PIRAO 
BRNG( I ) =BRnGO( I ) /PI RAO 

2 CONTINUE 

GENERATE RANDOM NOISE TO ADO TO KNOWN EMITTER BEARING 
ANGLES OF ARRIVAL AND AIRCRAFT POSITION FIXES. 

3 IXE = 5.':iX 
IXN=7-!'IX 

DO 4 I=1.NUM 

CALL GAUSS( IX. STDEV.AMEANt V) 

AMEANT=AMEANT+V/NUM 
VARIT=VARIT+V?:'’"2/NUM 
THETADC I ) = BRNGD( I ) + V 
THETA( I )=THETAD( I )/PIRAD 

IF( THETA ( I ) .GT.6.283186J THETA ( I ) =THETA ( I ) -6. 283 186 
IF(THETAD( I ) .GT .360.0) THE TAD ( I ) =THE TAD ( I ) -360. 0 
CALL GAUSS(IXE.STDEVN.AMEAN.V) 

AMEANE=AMEANE+V/NUM 
VARIE=VARI E+V« -. 2/NUM 
AC LOO ( I ) =ACLOMOI I) +V/6 00. 

ACLOR( I )=ACLOO( I ) /PIRAO 
CALL GAUSS ( IXN, STOEVN, AMEAN, V) 

AMEANN = AMEANi\!+V/NIJM 
VA R I N= V AR I N+ V :•••• 2/NUM 
ACLAO( I ) =ACLAMD{ I )-f-V/600. 

ACLAR( I )=ACLAD( I ) /PIRAO 

4 CONTINUE 
OEVNT=SORT(VARIT) 

DEVNE=SORT(VARIE) 

DEVNN=SORT(VARIN) 

IF(KFLAG.EO.NRUN) GO TO 6 
IF(KFLAG.NE. 1) GO TO 7 
WRITE(6, 201 ) 

WRITE! 6,49) { I ,TIMET( I ) .FREQ( !) , PRF( T ) , PW( I ) ,BRNGO( I ), 
IV.THETAO! I ) ,HDGO( I ) ,ACLAMD( I ) .ACLOMO(I) ,ALT( I) . 

2VELN( I ) ,VELE(I ) . I=1,NUM) 

WRITE! 6. 50) 

WRITE! 6, 51) !ACLAMD! I). ACLAO(I) ,ACLOMD!I ),ACLOD!I) , 
11=1, NUM) 

6 WRITE! 6, 202)AMEANT,0EVNT.AMEANE,DEVNE,AMEANN,DEVNN 

7 KFLAG=KFLAG+1 
RETURN 

48 FORMAT ( 6F11. 5) 

49 FORMAT!' ' , 13, 2X , F5 , 1 , 2X , F6 , 1 , 2X , F 5 . 1, 2X, F 4. 2, 2X , F 9. 5 , 
12X.F8.5.2X,F9.5,2X,F5.1,2X,F8.5,2X,F10.5,2X,2F8.1, 
2F3.1 ) 

50 FORMAT !3X, • LATITUDE NOISY LAT LONGITUDE NOISY ', 

1 'LONGITUDE ' , /) 

51 FORMAT !4F11. 5) 

201 FORMAT !' 1' ,36X, ' LISTING OF EMITTER TARGET DATA AND ', 
I'AIRCRAFT NAVIGATION DA TA ',///, 13X ,' TARGET PARAMETERS' 

2 ,37X, ' AIRCRAFT PARAMETERS',//,' JSET TIMET FREO ', 

3' PRF PW BRNGD V THETAD HDGD ', 

4' SLAD SLOD ALT VELN VELE',//) 

202 FORMAT! ///, 5X, 'NOISE ADDED TO BEARING ANGLES OF ', 

I'ARRIVAL' ,/,10X,'MEAN = ' , F 5 . 2 , / , lOX , ' S I GM A = ',F5.2, 
2//.5X, 'NOISE ADDED TO LONGITUDE FIXES',/, lOX.'MEAN', 
3' = ',F5.2, /, lOX, 'SIGMA = ', F5.2, //, 5X, 'NOISE 

4'ADDED TO LATITUDE FIXES'. /, lOX, 'MEAN = ', F5.2, /, 
510X, 'SIGMA = ', F5.2,///) 

END 
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SUBROUTINE READ 

SUBROUTINE TO READ ACTUAL AIRCRAFT PECM MISSION TAPES 



SUBROUTINE REAO(NUM) 

SUBROUTINE TO READ EMITTER TARGET AND AIRCRAFT 
NAVIGATION DATA FROM CARD DATA DECK 
DATA SEQUENCE MUST BE CF FORMAT TGT/NAV 



COMMON ACLAD(IOO) ,ACLAMD( 100) ^ACLAR(IOO) ,ACL0D(L00) , 

1 ACLOMD(IOO) ,ACL0R( 100) , ALT( 100 ) ,BRNG( 100) , BRNGD( 100) , 
2E( 100) , FREQ ( ICO) ,G1 (100) ,G2(100) .GATE (100) ,HDG(100), 
3HDGD( 100),K0DEN( 100 ) .M0DET( 100 ) , NST ( 1 00 ) , Pll ( 100) , 

4P12 (100 ) »P22 (100 ) . PITCH ( 100) ,PRF( 100) ,PW( 100) , 

5ROLL( 100) .SLA ( 100) .SLAD( 100) .SLO(IOO) ,S LCD (100), 

5T ( 100) ,T IMEN( 100 ). TIMET ( 100) . TOTD( 100) , TH TO ( 100) , 
6THTDK100) .THETA(IOO) . THET AD ( 1 00 ) , TL AD( 100),TL0D( 100), 
7VEL( 100) ,VELE( 1 00) , VELN ( 100) ,XTD( 100) , YTD( 100) , 
8D1K100 ), JSTdOO ) 

DATA PIRAD/57. 29578/ 

WRITE(6.53) 

DO 1 1=1,100 
NUM=I-1 

TYPE=11.0 EMITTER TARGET DATA 

READ ( 5, 51. END=2) TGT. TIMET( I ) ,8RNG( I ) ,PRF( I ) ,MODET ( I ) , 
IPWd } .FREO( I ) 

TYPE=7.0 AIRCRAFT NAVIGATION DATA 

RFA0(5.52) NAV.TIMENd ) .MODENd ) ,ALT( I ) ,ACLAR( I ) , 

1 ACLOR( I ) 

READ ( 5, 56) HDG( I ) , VELE( I ) .VELN (I ) ,ROLL( I ) , PITCH! I ) 
WRITE(6. 54) I.TIMET ( I ). FREQ( I ) ,BRMG( I ) , PRF( I ) , PW( I ) , 
1M0DET( I ) 

WRITE! 6, 55) TIM EN ( I ) ,HDG( I) ,ALT( I ) ,ACLAR( I ) , ACLORd ) , 

1 VELN ( I ) , VELE( I ) , ROLL ( I ). PITCH! I ) .MODEN! I ) 

SUBROUTINE TO COMPUTE AIRCRAFT VELOCITY 

VELS=VELE( I )'^-:'2 + VELN( I )^:s;}:2 
VEL ( I ) =SORT( VELS) 

1 CONTINUE 

SUBROUTINE TO CHANGE ANGLES AND LA TI TUDE / LONGI TUDE 

FROM RADIANS TO DEGREES + TENTHS OF DEGREES 

2 DO 5 J=1.NUM 

HDGD( J ) = HDG( J )^^PIRAQ 
BRNGD( J)=BRNG( J ) '■ PI RAO 
ACLAD( J)=ACLAR( J)'NPIRAD 
ACLOD( J )=ACLOR( J j-i- PIRAD 
ACLAMDI J )=ACLAO( J ) 

ACLOMD( J)=ACLOD( J) 

THETA! J) =BRNG( J)+HDG( J) 

IF (THETA! J ) .GT .6o28 3186) THETA ( J ) =THETA ( J )-6. 283186 
THETAO! J ) =BRNGD( J ) +HDGO! J ) 

IF(THETAO( J ) .GT. 360.0) THE TAD ( J ) =THE TAD ( J ) -360. 0 
5 CONTINUE 

51 FORMAT! 7F11. 5) 

52 FORMAT ( 6F13. 5) 

53 FORMAT! • 1* ,36X, ‘ LISTING OF EMITTER TARGET DATA AND ', 

1‘AIRCRAFT NAVIGATION 0 ATA './//. 13X TARGET PARAMETERS' 
2 ,37X. • AIRCRAFT PARAMETERS',//,' TYPE TIME',4X, 

3'FREO BRNG PRF PW MO / TIME HDG ALT', 
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46X.'LAT LONG N.VEL E.VEL ROLL 

5,2X, 'MO* .// ) 

54 FGRMATC TGT ' , 1 3 ,1 X , F9 .3 , 1 X , F6 . 1 , IX , F7 . 5 » IX , F6 
1F4.2, IX, II ) 

55 FORMATC NAV ' ,43X , F9 . 3 , IX , F7 . 5 , IX , F7 . 1 , IX, F 8. 5, 
11X,F8.3,1X,F3.3,1X,F3.5,1X,F8.5,1X,F3.0,/) 

56 FORMAT ( 5F13. 5) 

RETURN 
END 



PITCH' 
It IX, 
1X,F8.5 
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